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ABSTRACT 


DESIGN  AND  CONSTRUCTION  OF  A  PORTABLE 
FORCE-REFLECTING  MANUAL  CONTROLLER 
FOR  TELEOPERATION  SYSTEMS 


For  certain  applications  such  as  space  servicing,  undersea  operations,  and 
hazardous  material  handling  tasks  in  nuclear  reactors,  the  environments  can  be 
characterized  as  uncertain,  complex  and  hazardous.  Human  lives  may  be  in  danger  if  they 
were  to  work  under  these  conditions.  As  a  result,  a  man-machine  system  called  a 
teleoperator  system  has  been  developed  to  work  in  these  types  of  environments.  In  a 
typical  teleoperator  system,  the  actual  system  operates  at  a  remote  site,  and  the  operator 
located  away  from  this  system  usually  receives  visual  information  from  a  video  image 
and/or  graphical  animation  on  the  computer  screen.  Additional  feedback,  such  as  aural 
and  force  information  can  enhance  the  performance  of  system  significantly. 

Force  reflection  is  a  type  of  force  feedback  in  which  forces  experienced  by  the 
remote  manipulator  are  fed  back  to  the  manual  controller.  Various  control  methods  have 
been  proposed  to  implement  on  a  teleoperator  system.  In  order  to  examine  different 
control  schemes,  a  one-Degree-Of-Freedom  (DOF)  Force-Reflecting  Manual  Controller 
(FRMC)  is  constructed  and  integrated  into  a  PC.  The  system  parameters  are  identified 


iv 


and  constructed  as  a  mathematical  model.  The  PID  and  fuzzy  logic  controllers  are 
developed  and  tested  experimentally.  Numerical  simulation  results  obtained  from  the 
mathematical  model  are  compared  with  that  of  experimental  data  for  both  types  of 
controllers. 

In  addition,  the  concept  of  a  telesensation  system  is  introduced.  A  telesensation 
system  is  an  advanced  teleoperator  system  that  attempts  to  provide  the  operator  with 
sensational  feedback.  In  this  context,  a  telesensation  system  integrates  the  use  of  Virtual 
Reality  (VR)  unit,  FRMC,  and  Graphical  User  Interface  (GUI).  The  VR  unit  is  used  to 
provide  the  operator  with  the  3-D  visual  effect.  Various  commercial  VR  units  are 
reviewed  and  features  compared  for  use  in  a  telesensation  system.  As  for  the  FRMC,  the 
conceptual  design  of  a  3-DOF  FRMC  is  developed  in  an  effort  to  make  the  system 
portable,  compact,  and  lightweight.  A  variety  of  design  alternatives  are  presented  and 
evaluated.  Finally,  a  GUI  software  package  is  developed  to  interface  with  several 
teleoperation  unit  components.  These  components  include  an  industrial  robot,  electric 
motor,  encoder,  force/torque  sensor,  and  CCD  camera.  The  software  includes  features 
such  as  position  scaling,  force  scaling,  rereferencing,  etc.,  and  is  intended  to  provide  a 
sound  basis  for  the  development  of  a  multi-DOF  FRMC  system  in  the  future. 


TABLE  OF  CONTENTS 


Acknowledgements . ij 

Abstract . . 

List  of  Tables . jx 

List  of  Figures . . 

Chapter  1.  Introduction . . 

1 . 1  Teleoperator  Systems .  1 

1.2  Telesensation  Systems . 3 

1 .3  Objectives  of  the  Current  Research . 4 

Chapter  2.  Background . 7 

2. 1  Previous  Works . 7 

2.2  Force-Reflecting  Teleoperation  System . 9 

2.2.1  Mechanical  Design  of  Force-Reflecting  Manual  Controllers . 10 

2.2.2  Force-Reflecting  Controller  Design . 21 

Chapter  3.  Force-Reflecting  Teleoperation  Subsystems . 27 

3.1  Actuators . 27 

3.2  Transmission  Systems . . 30 

3.3  Sensors . . 

vi 


3.3.1  Position  Sensing . 33 

3.3.2  Speed  Sensing . 34 

3.3.3  Force  and  Torque  Sensing . 34 

3.3.4  Temperature  Sensing . 35 

3.4  Computer  Hardware . 35 

3.5  Computer  Interface . 37 

3.5.1  Actuator  Controller . 37 

3.5.2  A/D,  D/A,  D/D  Controllers . 38 

3.6  Computer  Software . 38 

3.6.1  Supervisor  Interface  Software . 38 

3.6.2  Joystick  Control  Software . 41 

3.6.3  VR  Control  Software . 42 

3.7  Summary . 43 

Chapter  4.  Design  and  Development  of  a  1-DOF  FRMC . 45 

4.1  1-DOF  FRMC  Components . 45 

4.2  System  Setup  and  System  Characteristics . 55 

4.3  System  Identification . 57 

4.4  Model  Validation . 63 

Chapter  5.  Testing  and  Evaluation  of  Control  Methods  for  the  1-DOF  FRMC....  68 

5.1  PID  Controller . 68 

5.1.1  Simulation  of  PID  Controller . 69 


vii 


5.1.2  Experiments  on  1-DOF  FRMC  by  Implementing  the  PID  Controller  ...72 

5.2  Development  of  Fuzzy  Logic  Controller . 75 

5.2.1  Fuzzy  Logic  Controller  Simulation . 78 

5.2.2  Experiments  on  the  1  -DOF  FRMC  by  Implementing  the  Fuzzy  Logic 

Controller . 84 

5.3  A  Comparison  of  the  System  Performance  of  PID  Controller  and  Fuzzy 

Logic  Controller .  87 

5.4  Error  Caused  by  Nonlinear  System  Elements . 88 

Chapter  6.  Development  of  a  Telesensation  System . 93 

6. 1  Virtual  Reality  Unit . 93 

6.2  Design  of  a  3-DOF  Force-Reflecting  Manual  Controller . 100 

6.2.1  Actuator  System  Design  Alternatives . 101 

6.2.2  3-DOF  FRMC  Design  Alternatives . 108 

6.3  Development  of  Graphical  User  Interface  (GUI) . 116 

Chapter  7.  Conclusions,  Recommendations,  and  Future  Works . 121 

7.1  Conclusions . 121 

7.2  Recommendations . 124 

7.3  Future  Work . 125 

Appendix  Conceptual  Design  of  3-DOF  Force-Reflecting  Manual  Controller . 127 

•  Proposed  Design  1 . 128 


viii 


•  Proposed  Design  2 . 129 

•  Proposed  Design  3 . 130 

•  Proposed  Design  4 . 131 

References . 132 


ix 


LIST  OF  TABLES 


Table  2-1 .  Telerobotic  Systems  with  VR  Technologies  for  Medical  Applications . 21 

Table  4-1 .  Listing  of  Hardware/Software  Components  for  1  -DOF  FRMC  System  ....  46 

Table  4-2.  BM  200  Brushless  Servo  Motor  Specifications . 48 

Table  4-3.  Encoder  Specifications . 49 

Table  4-4.  BA20  Amplifier  Specifications . 50 

Table  4-5.  U500  Controller  Specifications . 51 

Table  4-6.  Current  Capacity  Requirement  for  the  BB501  Interface  Board . 52 

Table  4-7.  100M40A-U760  Force/Torque  Sensor  Specifications . 54 

Table  4-8.  Models  Represented  by  2nd,  3rd,  and  4th  Order  Systems . 62 

Table  4-9.  Gains  Used  in  the  System  Identification  Process . 65 

Table  5-1 .  Gains  Used  in  Experiments  on  the  Actual  System . 72 

Table  5-2.  Centers  for  the  Position  Error  and  Velocity  Error  for  the  Membership 

Functions  from  Figure  5-6  and  5-7 . 80 

Table  5-3.  Look-Up  Table  Representing  Input  Voltage  of  the  Actuator . 82 

Table  6-1.  Brushless  DC  Motors  with  Frame . 102 

Table  6-2.  Motor  and  Speed  Reducer  Combination  Systems . 103 

Table  6-3.  Surveyed  Data  of  Frameless  Brushless  DC  Motors  Properties . 105 

Table  6-4.  Comparison  of  Speed  Reducer  System  and  Direct  Drive  Properties . 106 

Table  6-5.  Comparison  of  Design  Parameters  among  Design  Alternatives . 115 


LIST  OF  FIGURES 


Figure  1-1.  Information  Flow  in  Teleoperation  Systems . 2 

Figure  1-2.  Feedback  Components  of  a  Telesensation  System . 3 

Figure  1-3.  A  Pictorial  Representation  of  Components  in  a  Telesensation  System . 4 

F igure  2- 1 .  Kraft  Manual  Controller . 14 

Figure  2-2.  PER-Force  6-DOF  Force-Reflecting  Manual  Controller . 15 

Figure  2-3  PHANToM  System . 16 

Figure  2-4.  Stewart  Platform . 17 

Figure  2-5.  Six-DOF  Nine-String  Manual  Controller . 18 

Figure  2-6.  Three-DOF  Shoulder  Manual  Controller . 19 

Figure  2-7.  FIU  3-DOF  Force-Reflecting  Manual  Controller  Design . 20 

Figure  2-8.  Open-Loop  Control  of  a  Teleoperation  System . 22 

Figure  2-9.  Closed-Loop  Control  of  a  Teleoperation  System . 23 

Figure  3-1.  Teleoperation  System  Software  Structure . 39 

Figure  4-1 .  1  -DOF  FRMC  Components . 47 

Figure  4-2.  Setup  of  1-DOF  FRMC  Testbed . 56 

Figure  4-3.  Input-Output  Data  Collected  from  the  System . 61 

Figure  4-4.  Comparison  of  the  Actual  System  Response  with  2nd-,  3rd-,  and  4th-Order 

Model  Outputs . 62 

Figure  4-5.  Servo  Loop  of  U500  Controller . 64 

xi 


Figure  4-6.  Comparison  of  the  System  Response  between  the  Model  and 

Actual  System  for  the  Gain  Set  ID1  . 65 

Figure  4-7.  Comparison  of  the  System  Response  between  the  Model  and 

Actual  System  for  the  Gain  Set  ID2 . 66 

Figure  4-8.  Comparison  of  the  System  Response  between  the  Model  and 

Actual  System  Output  for  the  Gain  Set  ID3 . 66 

Figure  5-1 .  U500  PID  Controller  (Repeat) . 69 

Figure  5-2.  Simulated  System  Response  under  PID  Controller . 71 

Figure  5-3.  Position  Command  and  System  Response  of  PID1  Gains . 73 

Figure  5-4.  Position  Command  and  System  Response  of  PID3  Gains . 73 

Figure  5-5.  Position  Command  and  System  Response  of  PID6  Gains . 73 

Figure  5-6.  Comparison  of  the  Response  Errors . 74 

Figure  5-7.  Position  Error  Membership  Functions . 79 

Figure  5-8.  Velocity  Error  Membership  Functions . 79 

Figure  5-9.  Simulated  System  Response  under  Fuzzy  Logic  Controller . 83 

Figure  5-10.  Actual  System  Response  under  Fuzzy  Logic  Controller  of 

Base  Value  of  0.5 . 84 

Figure  5-11.  Actual  System  Response  with  Base  Values  between  0.35  to  0.5 . 85 

Figure  5-12.  Actual  System  Response  with  Base  Values  between  0.5  to  0.6 . 86 

Figure  5-13.  A  Comparison  of  System  Response  between  PID  and 

Fuzzy  Logic  Controllers . 87 

Figure  5-14.  Force-to-Velocity  Relation  of  Static  Friction . 89 


xii 


Figure  5-15.  Typical  Input-Output  Characteristics  of  an  Amplifier  with  Dead  Zone  and 


Saturation . 90 

Figure  5-16.  Typical  Input-Output  Characteristics  of  a  Quantizer . 91 

Figure  5-17.  Torque-Angle  Curve  of  a  Motor  or  Closed-Loop  System  with  Coulomb 

Friction . 92 

Figure  6-1 .  Visual  Immersion  Module  (VIM) . 97 

Figure  6-2.  Liquid  Image  MRG2.2 . 98 

Figure  6-3.  Virtual  Research  Systems  VR4 . 99 

Figure  6-4.  Personal  Use  Stereoscopic  Haptic  (PUSH) . 99 

Figure  6-5.  Inland  Brushless  DC  Motor  Model  RBE  01812 . 107 

Figure  6-6.  Proposed  Design  1  (Parallel  Configuration) . 109 

Figure  6-7.  Proposed  Design  2  (Parallel  Configuration) . 110 

Figure  6-8.  Proposed  Design  3  (Parallel  Configuration) . 112 

Figure  6-9.  Proposed  Design  4  (Serial  Configuration) . 113 

Figure  6-10.  Windows-Based  Version  of  the  Interface  Software . 117 

Figure  6-11.  DOS-Based  Version  of  the  Interface  Software . 118 

Figure  6-12.  Flowchart  of  the  Interface  Software . 120 


This  Page  Intentionally  Left  Blank 


xiv 


CHAPTER  1 


INTRODUCTION 

As  technology  becomes  more  advanced,  machines  become  more  complex  and  intelligent. 
For  instance,  industrial  robots  nowadays  are  able  to  make  decisions  and  work  autono¬ 
mously.  However,  for  some  of  the  tasks  found,  for  instance,  in  nuclear  waste  cleanup  op¬ 
erations  or  in  space,  even  the  most  intelligent  autonomous  robot  cannot  perform  all  the 
tasks  successfully.  In  order  to  achieve  the  goal,  humans  must  be  a  part  of  the  system. 

The  concept  of  “man  in  the  loop”  is  introduced  in  the  so-called  teleoperator  sys¬ 
tem.  The  purpose  of  having  humans  in  the  system  is  to  guide  machines  to  do  the  tasks 
properly  since  he/she  cannot  perform  these  tasks  by  himself/herself  as  the  environment 
conditions  may  be  harmful.  In  some  cases,  the  remote  site  may  be  a  thousand  miles  away 
from  the  operating  station.  Therefore,  better  interface  between  these  two  stations  is  a 
must  to  carry  out  many  operations  safely  and  reliably. 

1.1  Teleoperator  Systems 

Teleoperation  is  a  general  term  that  refers  to  a  human-machine  remote  control 
system.  The  system  usually  consists  of  two  robot  manipulators  that  are  connected  in  such 
a  way  as  to  allow  the  human  operator  controls  one  of  the  manipulators  (the  master  arm) 
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to  generate  commands  which  map  to  the  remote  manipulator  (the  slave  arm).  A  teleop¬ 
erator  system  generally  consists  of  a  manual  controller,  control  hardware/software,  sen¬ 
sory  feedback,  and  a  remote  manipulator.  Teleoperation  tasks  are  distinguished  by  the 
continuous  interaction  between  a  human  operator,  teleoperator  system,  and  the  environ¬ 
ment  as  illustrated  in  Figure  1-1. 


Remote  System 

Human  /  Machine 
Interface 

ManualController  | 

Robot  /  Platform 

Display 

GUI  Software 

Actuators 

Control  Software 

Actuators 

Sensors 

* _ j 

Interface  Software 

Sensors 

1 

Figure  1-1.  Information  Flow  in  Teleoperation  Systems 


The  main  function  of  the  teleoperator  system  is  to  assist  the  operator  to  perform 
and  accomplish  complex,  uncertain  tasks  in  hazardous  and  less  structured  environments 
such  as  space,  nuclear  reactors,  and  underwater  operations,  with  ease,  comfort,  and  fidel¬ 
ity.  For  instance,  robotic  technologies  have  been  used  to  inspect,  maintain  and  service 
nuclear  power  plants  [Tosunoglu  and  Hamel,  1994],  As  a  result,  the  radiation  exposure  of 
workers  at  the  plants  has  been  reduced  to  the  lowest  possible  level  [Rochelear  and  Crane, 
1991].  In  a  typical  teleoperator  system,  the  operator  receives  feedback  information  that 
includes  aural,  tactile,  and  force  feedback.  Although  the  audio  channel  may  be  useful  to 
the  operator,  the  sound  is  often  limited  from  the  system  [Draper,  1995], 
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1.2  Telesensation  Systems 

In  past  decades,  teleoperator  systems  have  been  developed  to  the  point  where  the 
human  operator  is  able  to  perceive  the  feelings  as  if  he/she  were  in  the  actual  environ¬ 
ment.  Such  a  system  is  also  referred  to  as  telepresence.  A  more  recent  goal  in  the  devel¬ 
opment  of  teleoperation  is  called  telesensation.  Telesensation  refers  to  a  remote  control 
system  that  combines  the  use  of  computer  vision,  computer  graphics  and  virtual  reality 
[Terashima,  1994].  The  word  “telesensation”  has  also  been  used  in  literature  to  describe  a 
telecommunication  system  such  as  teleconferencing  where  people  from  different  remote 
locations  in  the  real  world  are  able  to  hold  a  meeting  or  work  cooperatively  in  the  same 
artificial  world. 

In  the  field  of  robotics,  the  term  “telesensation”  implies  the  advanced  teleoperator 
system  that  provides  the  operator  with  sensation  feedback  by  employing  the  five  senses 
(if  possible).  As  a  result,  the  operator  is  able  to  perceive  the  “feel”  of  presence  at  a  re¬ 
mote  site  while  he/she  is  in  a  safe  workstation.  The  feel  of  presence  can  be  provided  by 
feedback  information  such  as  visual,  aural,  tactile,  and  force  feedback  as  represented  in 
Figure  1-2. 


Figure  1-2.  Feedback  Components  of  a  Telesensation  System 
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A  flexible  programming  environment  and  better  integration  of  human  and  com¬ 
puter  capabilities  highlight  the  advanced  teleoperation  technology  [Schenker  et.  al., 
1991].  The  telesensation  system  as  depicted  in  Figure  1-3  integrates  the  use  of  an  ad¬ 
vanced  operator  interface,  virtual  reality  unit,  force-reflecting  manual  controller,  and  sen¬ 
sor-based  manipulator  to  provide  the  feel  of  presence  at  the  remote  site  [Batsomboon  et. 
al.,  1996b].  Thus,  with  the  skilled  operator  and  the  sophisticated  systems,  the  tasks  can  be 
accomplished  with  the  most  efficient  and  effective  manner. 


Figure  1-3.  A  Pictorial  Representation  of  Components  in  a  Telesensation  System 


1.3  Objectives  of  the  Current  Research 

One  of  the  desired  objectives  in  the  development  of  teleoperator  systems  is  to  de¬ 
sign  and  develop  a  system  that  provides  the  operator  with  the  sensation  feedback.  A 
force-reflecting  manual  controller  is  one  of  the  components  in  the  system  that  provides 


the  operator  with  force  feedback.  Unfortunately,  most  of  the  manual  controllers  are 
bulky,  complicated  and  expensive.  For  the  system  to  be  used  in  a  practical  situation,  the 
system  must  be  portable,  compact,  lightweight,  easy  to  use,  and  easy  to  manufacture. 
Other  requirements  include  large  workspace,  sufficient  force  reflection  and  safe  design. 

In  this  work,  the  design  and  development  of  a  portable  force-reflecting  manual 
controller  is  addressed  as  a  design  problem.  This  includes  conceptual  design  of  the  sys¬ 
tem,  construction  of  a  testbed,  system  parameter  identification  of  the  testbed,  develop¬ 
ment  of  control  strategies  and  interface  software,  system  integration,  testing  and  labora¬ 
tory  demonstration. 

In  order  to  satisfy  the  above  requirements,  the  previous  works  have  been  investi¬ 
gated  for  mechanical  and  control  designs.  In  addition,  a  survey  of  mechanical  compo¬ 
nents  such  as  actuator  systems  and  sensors  has  been  conducted  to  identify  compact  size, 
lightweight  and  high-performance  components.  The  conceptual  designs  of  3-DOF  force- 
reflecting  manual  controller  are  presented  while  the  principle  of  the  force-reflection  is 
demonstrated  on  a  1-DOF  testbed. 

The  contents  of  each  chapter  are  summarized  as  follows: 

Chapter  1:  The  concept  of  teleoperator  and  telesensation  systems  is  introduced. 
Then,  the  objectives  and  the  scope  of  this  work  are  outlined. 

Chapter  2:  Background  on  force-reflecting  teleoperation  systems  is  presented  by 
first  listing  the  history  of  the  previous  work  in  chronological  order.  Some  of  these  works 
are  reviewed  in  detail  with  respect  to  their  mechanical  designs.  The  control  strategies  of 
these  systems  are  also  presented. 
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Chapter  3:  The  components  of  a  force-reflecting  teleoperation  subsystem  are  re¬ 
viewed.  These  components  are  divided  into  three  main  categories:  actuators,  sensors,  and 
computers. 

Chapter  4:  Telesensation  system  development  is  presented.  This  includes  three 
main  components  of  the  telesensation  system:  virtual  reality  unit  (VR),  force-reflecting 
manual  controller  (FRMC),  and  graphical  user  interface  software  (GUI). 

Chapter  5:  The  1-DOF  force-reflecting  manual  controller  prototype  is  discussed. 
This  chapter  provides  information  on  the  system  components  and  setup.  In  addition,  the 
system  parameters  are  identified  in  order  to  obtain  a  mathematical  model  for  the  system. 

Chapter  6:  Testing  of  the  1-DOF  testbed  and  evaluation  of  results  are  presented. 
Two  control  strategies,  one  based  on  PID,  and  the  other  on  fuzzy  logic,  are  developed  and 
tested  on  the  1-DOF  system.  The  PID  represents  the  traditional,  and  fuzzy  logic  more  re¬ 
cent  controller  development  efforts.  Evaluation  is  based  on  the  comparison  of  experi¬ 
mental  results  to  that  of  numerical  simulations. 

Chapter  7:  The  conclusions  and  recommendations  derived  from  this  work,  and 
future  work  to  be  conducted  are  presented. 
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CHAPTER  2 


BACKGROUND 

In  this  chapter,  the  milestones  in  teleoperation  system  development  are  presented,  and 

some  of  the  previous  teleoperation  system  designs  are  reviewed. 

2.1  Previous  Works 

•  1947.  Ray  Goertz  and  his  group  developed  the  first  manual  controllers  at  the  Argonne 
National  Laboratory  (ANL).  The  system  was  mechanically  and  electrically  connected. 

•  1948.  Ray  Goertz  and  his  companies  developed  the  Model-1  bilateral  mechanical 
master-slave  manipulator. 

•  1948.  General  Mills  produced  the  Model-A  unilateral  manipulator  in  which  the  arms 
and  hands  were  driven  by  switch-controlled  motors  rather  than  by  direct  mechanical 
or  electrical  linkage  to  the  operator. 

•  1954.  Ray  Goertz  and  his  group  developed  the  first  bilateral  force-reflecting  servo- 
manipulator. 

•  1958.  First  mobile  manipulator  with  TV  was  built  at  ANL.  This  teleoperator  was 
called  a  “slave  robot.” 
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•  1958.  Ralph  S.  Mosher  and  co workers  at  General  Electric  produced  a  manipulator 
which  included  force  reflection  and  an  exoskeleton  master  controller  called  the 
Handyman  Electro-Hydraulic  manipulator. 

•  1961.  The  first  manipulator  was  fitted  to  a  manned  deep-sea  submersible  when  a 
General  Mills  Model  150  manipulator  was  installed  on  the  Trieste. 

•  1966.  Jones  and  Thousand  developed  one  of  the  first  dextrous  master  manipu'ators 
using  pneumatic  bladders. 

•  1968.  J.  Allen  and  A.  Karchak,  at  Rancho  Los  Amigos  Hospital,  constructed  position- 
controlled  anthropomorphic  manipulators. 

•  1970’s.  NASA  developed  an  advanced  teleoperator  system.  The  Remote  Manipulator 
System  (RMS)  was  developed  for  the  space  shuttle. 

•  1 977.  Teleoperator  System  Corporation  created  a  force-reflecting  manipulator  called 
SM-229,  which  was  designed  to  be  used  in  a  nuclear  plant. 

•  1 970’s.  The  Center  for  Intelligent  Machines  and  Robotics  (CIMAR)  of  the  University 
of  Florida  developed  a  6-DOF  nine-string  manual  controller  and  a  4-DOF  force- 
reflecting  planar  controller. 

•  1980.  Hill  and  Salisbury  at  Stanford  Research  Institute  (SRI)  joined  by  Bejczy  at  Jet 
Propulsion  Laboratory  (JPL)  developed  a  bilateral  6-DOF  force-reflecting  manual 
controller. 

•  1980’s.  Oak  Ridge  National  Laboratory  (ORNL)  developed  the  M-2  Maintenance 
System  and  the  Advanced  Servomanipulator  (ASM)  master-slave,  force-reflecting 
teleoperator  system  for  the  use  of  maintenance  in  a  nuclear  plant. 
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•  1980’s.  Whitney  at  Draper  Laboratory  at  MIT  designed  and  developed  a  hand  con¬ 
troller  which  implemented  resolved  motion  rate  control. 

•  1985.  Tesar  and  Tosunoglu  at  the  University  of  Texas  at  Austin  developed  a  6-DOF 
nine-string  force-reflecting  manual  controller  and  a  3-DOF  spherical  force-reflecting 
shoulder  controller. 

•  1985.  Landsberger  and  Sheridan  developed  a  parallel-structured  arm  using  cables  in 
tension  and  a  single  passive  compressive  spine. 

•  1992.  Rutgers  University  CAIP  Center  developed  portable  I/O  device  called  Rutgers 
Master. 

•  1993.  German  Space  Agency  (DLR)  developed  the  first  space  telerobot  called  “Rotex 
Experiment.” 

•  1993.  EXOS  Inc.  developed  the  first  commercial  systems  designed  for  virtual  object 
manipulation  called  Touch  Master  and  SAFIRE  Master. 

•  1993.  MIT  Artificial  Intelligence  Laboratory  developed  the  PHANToM  Master  which 
was  designed  for  virtual  force  feedback.  The  system  was  made  available  commer¬ 
cially. 

2.2  Force-Reflecting  Teleoperation  System 

In  a  force-reflecting  teleoperation  system,  the  operator  uses  the  manual  controller 

to  direct  the  remote  manipulator  and  receives  visual  information  from  a  video  image 

and/or  graphical  animation  on  the  computer  screen.  A  virtual  reality  unit  may  be  provided 

to  improve  perception.  While  the  input  motion  moves  the  remote  system,  forces  experi- 
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enced  by  the  system  are  reflected  at  the  manual  controller,  so  that  the  operator  feels  the 
forces  acting  on  the  system. 

Force  reflection  is  most  helpful  when  other  sensory  feedback  such  as  vision  is  ab¬ 
sent  [Draper  et.  al.,  1987],  In  such  situations  where  there  are  dust  or  gases  involved  or 
when  the  environment  is  dark,  viewing  by  television  cameras  is  difficult  or  almost  impos- 
sib  e.  The  force  reflection  becomes  the  most  important  infc  .mation  for  the  operator  to 
complete  the  tasks.  The  operator  with  force  reflection  tends  to  make  fewer  attempts  to 
complete  a  given  task  than  the  operator  who  receives  no  force  reflection  [Draper,  1995], 

2.2.1  Mechanical  Design  of  Force-Reflecting  Manual  Controllers 

The  architectures  of  force-reflecting  manual  controllers  can  be  divided  into  two 
main  categories:  serial  and  parallel.  Most  of  the  force-reflecting  manual  controllers  use  a 
serial  structure  because  of  its  design  simplicity  and  large  workspace.  However,  the  paral¬ 
lel  structure  is  a  promising  design  in  some  aspects.  The  parallel  design  allows  the  actua¬ 
tors  to  be  located  on  the  fixed  base.  Thus,  it  provides  higher  stiffness  and  better  precision 
[Batsomboon  and  Tosunoglu,  1996a;  Conklin  and  Tosunoglu,  1996].  In  addition,  parallel 
mechanisms  tend  to  be  more  compact  than  serial  mechanisms.  Some  of  the  well-known 
serial-  and  parallel-structured  manual  controllers  are  reviewed  below. 
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Serial-Structured  Force-Reflecting  Manual  Controller  Designs 

Teleoperator  System  SM-229 

In  1977,  Teleoperator  System  Corporation  developed  a  bilateral  force-reflecting 
servo  master-slave  manipulator  called  SM-229.  It  had  seven  degrees  of  freedom  with  a 
3.7  m3  workspace.  It  was  designed  to  serve  the  requirements  of  a  variety  of  new  installa¬ 
tions  in  nuclear  plants  Conceivably,  the  SM-229  was  the  first  member  of  a  family  of 
force-reflecting  electric  master-slave  manipulators  designed  to  be  produced  commercially 
and  maintainable  [Martin  and  Kuban,  1985]. 

Bilateral  Force-Reflecting  6-DOF  Manual  Controller 

In  1980,  Jet  Propulsion  Laboratory  (JPL)  and  Stanford  Research  Institute  (SRI) 
developed  a  universal,  bilateral  force-reflecting  6-DOF  manual  controller  [Kim,  1991]. 
The  design  effort  was  to  minimize  friction,  backlash  and  inertia  at  the  handgrip.  The  sys¬ 
tem  used  the  cable/pulley-based  counter-balancing  and  power  transmitting  mechanism 
which  was  capable  of  generating  a  force  up  to  35  oz  at  the  handgrip.  In  addition,  a  coun¬ 
terbalance  assembly  was  included  in  the  system  to  reduce  gravitational  effects  [Bejczy 
and  Salisbury,  1980]. 

Handyman 

The  Handyman  electrohydraulic  manipulator  was  developed  by  General  Electric 
company  in  1985  [Kim,  1991].  The  system  includes  articulated  fingers  and  an  exoskele¬ 
ton  force-reflecting  master  arm.  However,  the  Handyman  did  not  prove  to  be  practical  for 
several  reasons.  One  of  the  biggest  factors  was  the  limitation  of  the  technology  at  that 
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time.  Other  factors  included  its  large  size  and  overall  reliability  [Mosher  and  Wendel, 
I960], 

Remote  Manipulator  System  (RMS) 

In  the  1970’s,  NASA  developed  the  Remote  Manipulator  System  (RMS)  for  the 
space  shuttle  [Kim,  1991].  The  system  uses  two  3 -DOF  hand  controllers:  one  for  transla¬ 
tional  motion  and  the  other  for  rotatio  .al  motion  of  the  end  effector  [Ravindran  et.  al., 
1984].  The  controllers  do  not  reflect  forces  experienced  by  the  RMS.  The  RMS  primarily 
uses  a  resolved  unilateral  rate  control  of  the  individual  joints;  hence,  it  essentially  con¬ 
trols  only  position  of  the  remote  system. 

Maintenance  System  (M-2) 

The  Model  M-2  Maintenance  System  was  developed  at  the  Oak  Ridge  National 
Laboratory  (ORNL)  in  an  effort  to  improve  remote  manipulation  technology  for  nuclear 
fuel  reprocessing  and  other  remote  applications  [Martin  and  Kuban,  1985].  The  system 
consists  of  two  force-reflecting  master  controllers  for  two  servomanipulator  arms,  televi¬ 
sion  viewing,  lighting  and  auxiliary  lifting  capabilities.  The  touch-screen  system  was 
used  as  an  interface  between  the  operator  and  the  remote  manipulators.  The  features  in¬ 
clude  force  ratio  selection,  camera/lighting  control  and  system  status  diagnostics. 

Advanced  Servomanipulator  (ASM)  System 

This  remote  maintainable  force-reflecting  servomanipulator  system  was  also  de¬ 
veloped  at  ORNL  [Martin  and  Kuban,  1985].  The  main  objective  of  the  ASM  was  to  use 
it  in  reprocessing  maintenance  which  required  reliability,  radiation  tolerance  and  corro¬ 
sion  resistance.  The  ASM  uses  eight  remotely  replaceable  module  types  where  each 
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module  weighs  less  than  23  kg  so  that  they  can  be  carried  by  another  ASM.  The  servo- 
manipulator  used  torque  tubes  which  provide  a  payload  capacity  of  23  kg.  One  of  the 
main  differences  of  the  ASM  from  the  traditional  system  is  the  anthropomorphic  (elbow- 
down)  geometry.  The  reason  for  this  was  that  the  system  was  designed  to  work  on  objects 
in  a  vertical  plane. 

MEL  Master  Arm 

The  Mechanical  Engineering  Laboratory  of  the  Ministry  of  International  Trade 
and  Industry  (MITI)  had  developed  the  MEL  master  arm  for  teleoperation  and  VR  appli¬ 
cations  [Kotoku  et.  al.,  1989;  Kotoku  et.  al.,  1992].  The  workspace  is  about  40  x  42  x  30 
cm  and  able  to  provide  force  feedback  up  to  20  N  in  translation  and  0.4  N-m  torque  about 
the  arm  handle.  Unlike  the  6-DOF  JPL  universal  master  arm,  the  MEL  arm  has  four  de¬ 
grees  of  freedom  and  uses  direct-drive  AC  brushless  motors.  A  SUN  25-MHz  Sparc 
workstation  is  used  to  display  VR  simulations. 

Dextrous  Arm  Master 

The  Dextrous  Arm  Master  has  a  total  of  ten  degrees  of  freedom,  seven  DOF  in  the 
arm  and  three  DOF  at  the  wrist  [Jacobsen  et.  al.,  1991].  Each  joint  contains  a  hydraulic 
actuator/servovalve,  load  cell,  and  a  high-precision  potentiometer.  The  system  has  a  rela¬ 
tively  high  bandwidth  of  100  Hz  at  the  wrist  and  provides  a  maximum  torque  of  5.5  N-m 
at  the  hand  (97.7  N-m  at  shoulder  and  22  N-m  at  wrist).  The  system  was  originally  devel¬ 
oped  by  SARCOS  Co.  for  underwater  teleoperation  applications  [Burdea,  1996]. 
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FREFLEX  Master 


The  7-DOF  electrical  Force  REFLecting  EXoskeleton  Master  is  developed  for  re¬ 
search  at  the  Wright-Patterson  Air  Force  Base  [Burdea,  1996].  The  system  provides  25  N 
of  force  feedback  at  the  handgrip  using  cables  to  transmit  forces  to  the  user’s  hand.  How¬ 
ever,  due  to  the  large  inertia,  gear  friction  and  backlash,  the  system  bandwidth  is  limited 
to  20  Hz  though  the  control  bandwidth  is  about  200  Hz. 

Kraft  KMC-9100 

The  Kraft  KMC-9100  force-reflecting  hand  controller  shown  in  Figure  2-1  is  pro¬ 
duced  by  Martin  Marietta/Kraft.  This  compact  system  has  six  degrees  of  freedom  and  is 
able  to  reflect  forces  up  to  5  pounds  when  fully  extended.  It  is  kinematically  similar  to  the 
human  arm  which  creates  an  intuitive  relationship  between  the  operator’s  movements  and 
those  translated  to  the  manipulator.  It  was  intended  to  be  used  for  the  Flight  Telerobotic 
Servicer  (FTS). 
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Cybernet  System  PER-Force 

Two  versions  of  PER-Force,  3  DOF  and  6  DOF,  have  been  produced  by  the  Cy¬ 
bernet  System  Corporation.  The  3-DOF  version  consists  of  three  30  oz-in  brushless  DC 
motors.  It  is  capable  of  reflecting  a  maximum  force  of  9  pounds  and  yet  the  joystick  unit 
weighs  only  4.5  pounds.  The  6-DOF  version  (Figure  2-2)  incorporates  three  linear  axes 
with  the  position  resolution  of  0.0003”  per  location  and  three  revolute  axes  with  1/90  de¬ 
gree  or  40  seconds  position  resolution.  The  unit  was  originally  designed  for  the  Space 
Station.  Both  versions  can  be  controlled  by  IBM,  VME  or  Macintosh-compatible  com¬ 
puters. 


Figure  2-2.  PER-Force  6-DOF  Force-Reflecting  Manual  Controller 

PHANToM 

The  Personal  Haptic  Interface  Mechanism,  PHANToM,  is  the  three-DOF  “thim- 
ble-gimbal”  desktop  device  that  provides  a  force-reflecting  interface  between  a  human 


15 


user  and  a  computer  [Massie  and  Salisbury,  1994],  The  system  shown  in  Figure  2-3, 
which  has  been  developed  at  the  MIT  Artificial  Intelligence  Laboratory,  enables  the  user 
to  manipulate  and  feel  the  virtual  objects.  PHANToM  consists  of  three  DC  brushed  mo¬ 
tors  with  encoders  and  the  human  finger.  The  encoders  are  used  to  track  the  operator’s 
finger  tip  in  the  x,  y,  and  z  coordinates  while  the  motors  control  the  forces  exerted  upon 
the  operator.  The  system  is  able  to  provide  a  maximum  force  reflection  of  1 0  N  and  con¬ 
tinuous  force  of  1.5  N. 


Figure  2-3.  PHANToM  System 


Parallel-Structured  Force-Reflecting  Manual  Controller  Designs 
Stewart  Platform 

The  Stewart  platform  (Figure  2-4)  was  first  introduced  by  Stewart  [Kim,  1991].  It 
has  six  degrees  of  freedom  and  uses  all  six  actuated  prismatic  joints.  The  prismatic  ac¬ 
tuators  are  usually  not  backdrivable,  but  with  the  addition  of  a  load  cell  in  the  actuators. 
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the  Stewart  platform  can  be  made  backdrivable  and  able  to  provide  force  feedback.  This 
design  has  attracted  many  teleoperation  system  developers  because  of  the  high  force 
feedback  produced  by  the  system  [Burdea,  1996]. 


Figure  2-4.  Stewart  Platform 


Haptic  Master 

Based  on  the  Stewart  platform  design  and  an  earlier  prototype  developed  by  Iwata 
at  the  University  of  Tsukuba,  Nissho  Electronics  Co.  of  Japan  has  produced  Haptic  Mas¬ 
ter  [Burdea,  1996].  Haptic  Master  has  six  degrees  of  freedom  but  uses  nine  actuators  to 
eliminate  kinematic  singularities  in  the  workspace.  The  system  workspace  is  a  40-cm- 
diameter  sphere  centered  on  the  mobile  platform  and  can  provide  a  maximum  of  69  N  of 
force  feedback. 

Nine-String  Force-Reflecting  Six-DOF  Manual  Controller 

Nine-string  six-DOF  manual  controller  (Figure  2-5)  has  been  developed  at  the 
University  of  Texas  at  Austin  [Lindemann  et.  al.,  1987],  The  system  is  capable  of  re- 
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fleeting  forces  up  to  ten  pounds  by  using  nine  actuators  to  control  nine  string  tensions.  In 
addition,  three  constant-pressure  air  cylinders  are  used  to  provide  constant  compression 
forces  where  the  strings  cannot  provide  the  force  needed.  The  workspace  has  no  singu¬ 
larities,  and  because  the  motion  of  each  string  is  measured  by  a  potentiometer,  the  com¬ 
putational  burden  is  reduced.  On  the  other  hand,  the  system  is  rather  bulky  and  has  rela¬ 
tively  high  friction  from  the  pneumatic  cylinders. 


Figure  2-5.  Six-DOF  Nine-String  Manual  Controller 

Three-DOF  Spherical  Shoulder  Manual  Controller 

A  three-DOF  spherical  shoulder  manual  controller  (Figure  2-6)  has  also  been  de¬ 
veloped  at  the  University  of  Texas.  This  system  has  almost  the  same  features  as  the  nine- 
string  controller  except  that  it  has  only  three  degrees  of  freedom.  As  in  most  parallel- 
structured  mechanisms,  the  spherical  shoulder  allows  the  location  of  heavy  actuators  on 
the  base;  thus,  increasing  the  payload  capacity.  However,  because  each  actuator  is  inte- 


18 


grated  with  a  harmonic  drive  system  with  a  60:1  gear  ratio,  the  system  exhibits  high 
magnitudes  of  friction,  backlash  and  inertia  forces  due  to  the  high  gear-ratio  reducers  in 
the  actuator  modules  [Kim,  1991]. 


Figure  2-6.  Three-DOF  Shoulder  Manual  Controller 

Space  Interface  Device  for  Artificial  Reality  (SPIDAR) 

SPIDAR  used  stringed  force-feedback  interface  as  the  6-DOF  Texas  Nine-String 
manual  controller,  but  it  is  simpler  and  more  compact  [Burdea,  1996].  SPIDAR  was  de¬ 
veloped  by  Ishii  and  Sato  at  the  Tokyo  Institute  of  Technology  [Ishii  and  Sato,  1993]. 
The  system  initially  had  four  strings  attached  to  a  cap  worn  on  the  user’s  pointer,  but  later 
had  eight  strings  to  provide  force  feedback  to  thumb  and  pointer  finger.  To  manipulate 
virtual  objects,  SPIDAR  II  was  created.  Two  SPIDAR  IIs  were  combined  on  a  single 
support  frame  to  allow  the  user  to  operate  with  both  hands.  Each  hand  had  a  30-cm- 
diameter  spherical  workspace  within  a  planar  120  x  60  cm  structure. 
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FIU  Three-DOF  Manual  Controller 


The  conceptual  design  of  a  three-DOF  force-reflecting  manual  controller,  which 
was  developed  at  Florida  International  University,  is  shown  in  Figure  2-7.  The  system 
utilizes  a  direct  drive  setup  which  eliminates  the  need  of  intermediate  transmission  ele¬ 
ments  such  as  gears  or  belts.  As  a  result,  it  promises  zero  backlash  and  virtually  no  fric¬ 
tion.  The  system  consists  of  three  powerful,  small  rare-earth  permanent  magnet  brushless 
DC  motors  which  provide  a  maximum  reflected  force  of  five  pounds.  The  design  is  ex¬ 
pected  to  be  one  of  the  most  compact  three-DOF  manual  controllers. 


Figure  2-7.  FIU  3-DOF  Force-Reflecting  Manual  Controller  Design 

Recently,  telerobotic  systems  and  VR  technologies  have  attracted  many  research¬ 
ers  in  the  field  of  medication,  especially  for  surgical  training  [Burdea,  1996].  Interactive 
CD-ROM  anatomy  and  surgical  training  systems  have  been  available  commercially.  Ta¬ 
ble  2-1  briefly  describes  some  of  the  systems.  The  detailed  description  of  these  systems 
can  be  found  in  [Burdea,  1996]. 
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Table  2-1.  Telerobotic  Systems  with  VR  Technologies  for  Medical  Applications 


Systems 

Developed  by 

Description 

Lumbar-puncture 

Simulator 

Bostrom  and 
Colleagues 

-  3-DOF  haptic  interface 
- 1  mm  position  accuracy 
-ION  maximum  resistive  force 

Laparoscopic  Impulse 
Engine  for  force 

Feedback  in  VR  MIS 
simulations 

Rosenberg  and 
Stredney 

-  5  DOF  with  workspace  of  5  x  9  x  9  in. 

-  2  lb  maximum  translational  resistive 
force  and  60  oz-in  torque  about  the  pivot 
axes 

Telerobotic  system  for 
microsurgery 

Salcudean  and  Yan 

-  3  magnetically-levitated  wrists 

-  0.002  N  force  resolution  for  maximum 
cutting  force  of  1 .2  N 

Telerobotic  system  for 
training  needs  of 
Ophthalmic  surgery 

Hunter  and 
Colleagues 

-  A  pair  of  6-DOF  master-slave 

-  A  Head-Mounted  Display  (HMD)  is 
used  to  receive  audio  and  visual 
feedback 

2.2.2  Force-Reflecting  Controller  Design 

The  control  method  of  the  force-reflecting  teleoperation  system  can  be  divided 
into  two  categories:  position-position  and  position-force  [Vertut  and  Coiffet,  1986],  In  the 
position-position  method,  the  difference  of  the  position  between  the  master  arm  and  the 
slave  arm  is  used  to  derive  the  force  feedback.  This  method  is  used  when  the  two  arms 
have  similar  kinematics  configuration.  For  dissimilar  arms,  the  position-force  method  is 
used.  This  method  uses  direct  force  feedback  rather  than  position  error.  The  external  force 
that  the  slave  arm  experiences  is  measured  by  a  force/torque  sensor  which  is  attached  to 
the  wrist  of  the  robot.  This  force  is  reflected  to  the  operator  hand  via  the  master  arm  ac¬ 
cording  to  the  force  scaling  factor.  Since  this  feedback  signal  is  more  precise  than  the  po- 
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sition  error  signal,  the  position-force  method  can  provide  better  force-reflection  charac¬ 
teristics  to  the  operator  [Cha  et.  al.,  1996]. 

For  the  position-force  scheme,  two  control  modes  -  position  and  force,  must  be 
implemented  in  the  control  loops.  Whitney  notes  that  when  a  force  is  exerted  by  the  end- 
effector  on  the  environment,  a  force  control  mode  is  perpendicular  to  the  environment 
and  the  position  control  mode  can  be  exerted  to  the  environment  tangentially  [Whitney, 
1977], 

Figure  2-8  depicts  the  concept  of  an  open-loop  control  in  the  position-force 
method.  This  control  strategy  is  called  open  loop  because  each  of  the  position  and  force 
reflection  commands  is  fed  in  a  forward  (open  loop)  sense.  For  instance,  when  the  force 
feedback  feature  is  implemented,  the  reflected  force  will  be  adjusted  by  comparing  the 
difference  between  the  desired  and  actual  values  as  shown  in  Figure  2-8.  Such  an  open- 
loop  scheme  may  not  provide  satisfactory  results  because  the  control  system  is  unmod¬ 
elled  for  dynamics,  friction,  backlash,  delay,  etc.,  between  the  teleoperator  and  remote 
system.  As  a  result,  the  system  may  become  unstable. 


Command  Reflection 

Command 


Figure  2-8.  Open-Loop  Control  of  a  Teleoperation  System 
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A  more  sophisticated  control  scheme,  the  closed-loop  control,  is  shown  in  Figure 
2-9.  The  output  of  the  remote  system  is  directly  fed  back  to  the  input  of  the  manual  con¬ 
troller  while  the  local  feedback  loops  still  remain  in  the  control  loop.  This  closed-loop 
control  accounts  for  dynamics,  friction,  backlash,  delay  and  perhaps,  beam  damping 
which  is  an  important  parameter  for  the  long-reach  manipulator  [Jansen  et.  al.,  1991]. 


Figure  2-9.  Closed-Loop  Control  of  a  Teleoperation  System 


One  of  the  crucial  issues  in  the  force-reflection  control  system  that  needs  to  be 
addressed  is  time  delay.  The  round-trip  delay  can  be  as  much  as  2  seconds  in  the  deep 
ocean  or  6  seconds  in  the  case  of  the  earth-orbiting  space  shuttle  [Sheridan,  1993].  Under 
the  presence  of  time  delay  in  the  teleoperation  system,  force  reflection  becomes  trouble¬ 
some.  According  to  Ferrell’s  experiments,  it  is  unacceptable  to  feed  force  continuously 
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back  to  the  operator  because  the  unexpected  disturbance  can  cause  the  system  to  be  un¬ 
stable  [Ferrell,  1966].  Several  alternatives  have  been  proposed  to  deal  with  the  time- 
delayed  force  feedback,  such  as  displaying  force  feedback  in  the  visual  form,  feeding  the 
reflected  force  to  a  different  master  arm,  and  predicting  the  force  feedback  to  compensate 
for  the  delay  [Sheridan,  1993]. 

Currently,  some  of  the  well-known  position-force  control  methods  used  for  a 
force-reflecting  teleoperation  system  are  kinesthetic  force  feedback,  shared  compliant 
control  [Kim  et.  al.,  1992]  and  “telemonitoring”  sensory  feedback  [Lee  and  Lee,  1993]. 
These  methods  provide  force  feedback  except  that  kinesthetic  force  feedback  has  a  stiffer 
system.  In  kinesthetic  force  feedback,  the  forces  sensed  by  the  remote  manipulator  are  fed 
back  and  are  reflected  through  the  operator’s  manual  controller,  whereas  in  a  shared  com¬ 
pliant  control,  the  human  operator  shares  the  control  task  with  the  autonomous  compliant 
control  of  the  remote  manipulator.  In  the  telemonitoring  control  mode,  the  system  con¬ 
sists  of  a  position  control  with  a  position  error-based  force  reflection  and  remote  site 
compliance  [Lee  et.  al.,  1985].  Its  control  mode  basically  is  under  a  shared  compliant 
control  but  has  telemonitoring  force  feedback. 

When  there  is  no  significant  time  delay  involved,  all  three  control  modes  perform 
the  given  task  at  about  the  same  efficiency.  However,  under  the  presence  of  time  delay  in 
the  teleoperation  system  such  as  underwater  operations  or  in  space  operations,  force  re¬ 
flection  causes  problems.  The  system  displays  oscillation  and  most  critically,  may  be¬ 
come  unstable.  Experimental  results  show  that  the  kinesthetic  force  feedback  control 
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mode  cannot  be  operated  at  time  delays  above  0.5  to  1  second  because  of  the  instability 
problem  [Kim  et.  al.,  1992]. 

Shared  compliant  control  has  been  implemented  as  a  new  feature  added  to  the 
force-reflecting  telerobot  system.  In  shared  compliant  control,  the  human  operator  con¬ 
trols  the  compliant  robot  hand.  The  compliant  hand  reduces  the  contact  force  between 
robot  manipulator  and  objects.  Thus,  it  improves  smoothness  of  mechanical  contact  and 
safety. 

W.S.  Kim,  B.  Hannaford,  and  A.K.  Bejczy  at  Jet  Propulsion  Laboratory  (JPL) 
have  proven  the  superiority  of  shared  compliant  control  over  kinesthetic  force  feedback 
system  [Kim  et.  al.,  1992].  Their  experiment  demonstrates  that  shared  compliant  control 
is  able  to  perform  the  task  at  time  delays  above  1  second.  This  is  possible  because  the  en¬ 
tire  feedback  loop  remains  in  the  remote  side.  As  a  result,  time  delay  in  communication 
does  not  cause  a  stability  problem.  In  addition  to  the  time-delay  advantage,  the  comple¬ 
tion  time  is  also  reduced  when  shared  compliant  control  is  used  instead  of  kinesthetic 
force  feedback  [Kim  et.  al.,  1992]. 

S.  Lee  and  H.S.  Lee  at  the  Advanced  Teleoperation  (ATOP)  laboratory  of  JPL 
have  developed  a  teleoperator  control  system  called  “telemonitoring”  sensory  feedback 
[Lee  and  Lee,  1993].  The  control  mode  consists  of  position  control  with  position  error 
based  force  reflection  and  remote  site  compliance  [Lee  et.  al.,  1985].  Basically,  its  control 
mode  is  under  shared  compliant  control  while  having  telemonitoring  force  feedback.  The 
experiments  have  been  conducted  to  evaluate  and  compare  the  performance  of  various 
manual  control  methods  including  conventional  force  feedback,  shared  compliant  control 
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and  telemonitoring  force  feedback.  The  experimental  results  showed  that  the  telemoni¬ 
toring  force  feedback  was  always  ranked  first  [Lee  and  Lee,  1993].  They  revealed  that 
under  shared  compliant  control  mode,  the  operator  tends  to  make  larger  positional  and/or 
orientational  command  errors.  This  is  because  the  operator  does  not  know  how  much 
force  on  the  remote  manipulator  is  shared  by  the  compliant  control.  As  a  result,  the  op¬ 
erator  feels  uncertain  in  evaluating  commands  which  causes  more  erroneous  and  hesitant 
control  behavior.  They  also  suggest  that  when  the  proposed  system  is  compared  to  the 
conventional  force  feedback  and  shared  compliant  control,  it  is  expected  to  perform  better 
where  time  delay  is  significant  although  the  experiment  is  not  yet  verified. 
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CHAPTER  3 


FORCE-REFLECTING  TELEOPERATION  SUBSYSTEMS 


This  chapter  primarily  reviews  some  of  the  components  for  a  teleoperation  system.  The 
material  covers  the  major  components  such  as  the  actuators,  transmission  systems,  sen¬ 
sors,  computer  hardware,  computer  interface,  and  computer  software. 

3.1  Actuators 

Input  power  for  teleoperated  systems  is  provided  by  hydraulic,  pneumatic  or  elec¬ 
tric  actuators,  each  of  which  is  briefly  reviewed  below. 

Hydraulic  Actuator 

Hydraulic  actuators  are  usually  used  for  large  telemanipulators  because  hydraulic 
power  can  generate  relatively  high  forces  in  a  small  volume  with  good  rigidity  and  servo 
control  of  position  and  velocity  [Todd,  1986].  Thus,  the  manipulators  can  be  lightweight, 
which  allows  them  to  carry  more  weight  for  the  same  power  output  provided  by  an  elec¬ 
tric  motor.  However,  one  of  the  biggest  problems  with  hydraulic  systems  is  their  ten¬ 
dency  to  leak  oil  which  is  not  suitable  for  most  teleoperation  applications  [Poole,  1989]. 
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Pneumatic  Actuator 


Pneumatic  systems  are  based  on  the  pressure  available  from  compressed  air  reser¬ 
voir  and  their  valves  are  either  fully  on  or  fully  off,  where  each  actuator  stops  only  at  the 
end  of  its  travel.  Therefore,  pneumatic  actuators  are  often  used  only  for  the  gripper  of  an 
electric  or  hydraulic  manipulator  where  its  elasticity  is  useful  as  it  automatically  limits 
the  force  [Todd,  1986].  In  addition,  a  pneumatic  gripper  actuator  is  very  light  and  needs 
to  be  connected  only  by  a  narrow  flexible  tube  which  is  easy  to  feed  through  complex 
mechanisms  such  as  a  wrist. 

Electric  Actuator 

At  present,  electric  actuators  represent  about  70  percent  of  all  the  actuators  used  in 
robotics.  Some  of  the  advantages  of  the  electric  motors  that  make  them  more  popular  in 
industry  are  as  follows: 

•  High  reliability 

•  Low  friction 

•  Easily  controlled  by  a  computer  or  a  microprocessor 

•  Compact  size,  volume  and  weight  with  respect  to  the  power  output:  High 
Torque/Weight  ratio 

•  Less  frequent  maintenance  requirements 

•  Precise,  responsive,  clean  and  quiet  operation 
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•  Longer  life 

Electric  motors  can  be  categorized  in  several  ways,  but  for  the  teleoperation  appli¬ 
cations,  the  field  is  further  narrowed  and  only  the  stepper  and  servomotors  are  presented. 

Stepper  Motor 

A  stepper  motor  is  simple  to  use  and  control  in  an  open-loop  configuration. 
Commutation  and  position  are  controlled  by  step  and  direction  pulses.  It  provides  excel¬ 
lent  torque  at  low  speeds  which  is  suitable  in  robot  applications.  However,  stepper  motors 
can  cause  slippage  during  rapid  acceleration  and  when  overloaded.  The  error  produced  by 
this  slippage  can  go  undetected  and  cause  damage.  Thus,  in  order  to  control  an  open-loop 
system  accurately,  the  pulse  frequency  must  be  varied  during  times  of  acceleration.  On 
the  other  hand,  when  driving  light  loads,  stepper  motors  have  resonance  effects.  It  oscil¬ 
lates  around  the  stopped  position  and  overshoots.  To  eliminate  vibration  or  resonance  ef¬ 
fects  and  suppress  overshoot,  a  damping  system  is  required.  Generally,  a  stepper  system 
does  not  provide  any  kind  of  feedback  information.  Therefore,  a  feedback  device  must  be 
added  to  verify  position;  otherwise,  torque  cannot  be  controlled. 

Servo  System 

A  servomotor  is  used  in  a  closed-loop  configuration.  The  servo  control  systems 
include  those  elements  that  interface  with  the  controller  and  the  manipulator.  Each  ser¬ 
vomechanism  has  two  sensors  (one  receives  signals  from  and  the  other  sends  signals  to 
the  controller)  that  create  a  closed-loop  feedback  system.  The  control  system,  as  a  whole, 
uses  data  generated  by  the  feedback  system  to  monitor  movement.  The  computer  then 
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performs  calculations  to  determine  the  next  motion  and  directs  the  servomechanisms  to 
move  accordingly. 

Typical  servomotors  include  integrated  position  and  velocity  sensors.  Unlike  the 
stepper  motor  with  added  feedback  devices  that  make  the  necessary  corrections  between 
actual  and  desired  position  after  the  move,  the  servo  motor  continuously  monitors  actual 
information  such  as  position  and  velocity,  and  compares  those  values  to  desired  values 
and  makes  necessary  corrections  to  compensate  for  any  error. 

There  are  two  types  of  DC  servomotors:  Brush  and  brushless.  Conventional  DC 
motors  have  brushes  and  commutators.  The  main  drawback  of  this  type  of  motor  is  a 
maintenance  problem.  When  the  motor  is  loaded,  the  sliding  contact  between  the  brushes 
and  the  commutators  causes  an  arc,  and  both  components  must  be  replaced  when  they 
wear  out. 

The  other  type  of  DC  servomotor  is  the  brushless  type.  It  displays  the  same 
torque-speed  characteristics  as  a  conventional  DC  brush  motor.  Recently,  there  has  been 
an  increasing  interest  in  using  brushless  motors  in  high-performance  applications.  A 
number  of  practical  advantages  accrue  from  the  elimination  of  the  brushes  and  commu¬ 
tator.  The  brushless  motor  has  longer  life,  better  heat  dissipation  and  is  free  of  mainte¬ 
nance. 

3.2  Transmission  Systems 

Since  an  actuator  output  is  typically  at  higher  speeds  than  needed  in  teleoperation 
systems  and  actuators  are  too  large,  heavy  and  bulky  relative  to  the  output  power,  trans- 
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mission  systems  are  used.  Hence,  transmission  elements  are  added  to  provide  the  system 
with  higher  torque  while  keeping  the  actuator  systems  compact. 

Typical  transmission  components  are  gears,  tendons,  and  linkages.  However,  for 
advanced  teleoperator  systems,  gears  are  the  most  common  type  used  because  they  are 
capable  of  carrying  larger  payloads  and  are  more  accurate  than  the  other  two  types  men¬ 
tioned  above.  The  harmonic  drives  and  direct-drive  systems  have  also  become  popular  in 
industry. 

Gears 

Gears  are  the  most  common  transmission  elements  because  they  can  transmit 
large  torques  with  the  use  of  small  size  motors.  Hence,  the  systems  are  compact.  How¬ 
ever,  many  problems  are  encountered  when  using  gearing  systems.  One  of  the  biggest 
problems  is  backlash  which  causes  inaccurate  motion  control.  In  addition,  when  design¬ 
ing  a  gearing  system,  the  designer  must  consider  the  mechanical  nonlinear  properties 
such  as  friction  and  deflection. 

Harmonic  Drives 

Harmonic  drives,  which  use  a  special  gear  architecture,  are  usually  used  with 
revolute  joints.  A  number  of  advantages  of  harmonic  drives  over  the  other  transmission 
elements  can  be  summarized  as  follows:  high  gear  ratios,  compactness,  and  almost  zero 
backlash.  These  features  increase  accuracy.  However,  because  of  the  tight  mechanism, 
contact  area  between  the  teeth  is  considerably  larger  which  causes  high  friction. 
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Direct  Drive 


Recently,  the  development  of  motors  has  been  greatly  improved.  With  these  im¬ 
provements,  motors  have  been  able  to  provide  high  torques  with  relatively  small  sizes. 
This  advantage  allows  the  designer  to  develop  the  system  by  coupling  the  system’s  load 
directly  to  the  motor  without  the  use  of  transmission  elements  such  as  belts  or  gears.  Such 
a  system  is  known  as  direct  drive.  The  elimination  of  the  intermediate  transmission  pro¬ 
vides  the  system  with  better  accuracy  since  there  is  no  friction  or  backlash  introduced  to 
the  system.  The  reliability  of  the  system  is  also  improved  because  a  smaller  number  of 
components  is  used.  However,  one  of  the  main  problems  that  direct-drive  motors  en¬ 
counter  is  overheating.  As  the  intermediate  transmission  elements  are  eliminated,  the  load 
must  be  carried  by  the  motor  entirely  and  directly.  Thus,  the  motor  must  be  able  to  exert  a 
large  amount  of  continuous  torque  with  very  efficient  cooling;  otherwise,  the  motor  may 
be  burned  out. 

3.3  Sensors 

In  telesensation  systems,  the  goal  is  to  provide  the  operator  with  the  feeling  of 
presence  at  the  remote  site.  To  accomplish  this,  various  types  of  sensors  must  be  used  in 
the  system.  The  sensors  must  be  able  to  reproduce  faithfully  those  physical  properties  of 
the  working  environment,  and  they  must  be  sufficient  in  providing  sensational  feelings  to 
the  operator  so  that  he/she  can  complete  the  required  jobs  with  relative  ease  [Johnsen  and 
Corliss,  1971],  For  the  purpose  of  this  work,  the  sensors  are  divided  into  four  main  cate¬ 
gories. 
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3.3.1  Position  Sensing 
Encoders 

Encoders  are  used  to  control  position  by  translating  mechanical  motion  into  elec¬ 
tronic  signals.  There  are  a  number  of  types  used,  but  the  most  widely  used  are  the  optical 
encoders.  The  encoder  consists  of  a  glass  and  a  mylar  or  metal  wheel  with  alternating 
clear  and  opaque  stripes.  The  positions  are  monitored  by  the  detection  of  the  stripes  by 
optical  sensors  to  generate  the  output  position  in  digital  form.  Two  types  of  optical  en¬ 
coders  used  are  incremental  and  absolute  encoders. 

•  Incremental  encoder:  This  form  of  optical  encoder  produces  a  pulse  for  a  given 
increment  of  shaft  rotation.  Shaft  angular  rotation  is  determined  by  counting  the 
encoder  output  pulses. 

•  Absolute  encoder:  An  absolute  encoder  has  a  number  of  output  channels.  Each 
position  of  the  shaft  is  determined  by  the  unique  code.  As  a  result,  absolute  en¬ 
coder  is  preferable  for  applications  that  require  high  accuracy. 

Resolvers 

Resolvers  are  electromagnetic  feedback  devices  which  convert  angular  shaft  posi¬ 
tion  into  analog  signals.  These  signals  can  be  processed  in  various  ways  such  as  with  a 
resolver-to-digital  converter  to  produce  digital  position  information.  Resolvers  are  rugged 
devices  compared  to  encoders,  but  they  are  relatively  noise  insensitive  and  able  to  trans¬ 
mit  data  over  long  distances. 
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3.3.2  Speed  Sensing 

Tachometers 

Tachometers  are  electromagnetic  sensors  which  generate  an  output  voltage  signal 
proportional  to  shaft  velocity.  A  small  permanent  magnet  DC  motor  can  be  used  as  a  ta¬ 
chometer.  The  manufacturers  often  include  a  tachometer  in  DC  servo  motors  so  that  they 
are  able  to  produce  low-cost  and  high-performance  products. 

3.3.3  Force  and  Torque  Sensing 

Force  and  Torque  Sensors 

Force  sensors  measure  the  reaction  forces  between  the  object  and  the  environ¬ 
ment;  thus,  they  are  classified  as  external  sensors.  On  the  other  hand,  joint  torques  are 
sensed  with  internal  sensors.  In  order  to  obtain  accurate  results  from  force  sensors,  they 
should  be  installed  directly  on  the  gripper,  instead  of  between  the  wrist  and  the  end- 
effector.  This  is  because  the  weight  of  the  end-effector  can  take  up  most  of  the  dynamic 
range  of  the  sensors. 

Strain  gauges  are  usually  the  basic  sensing  elements  of  force  sensors.  A  torque 
sensor  has  the  transducer  in  a  sealed  unit  and  includes  a  microprocessor  unit  to  resolve 
the  measurements  that  are  applied  to  the  transducer  into  six  equivalent  Cartesian 
force/torque  components.  It  then  gives  the  output  information  via  a  standard  interface. 
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3.3.4  Temperature  Sensing 


Thermistors 

Changes  in  temperature  can  be  measured  and  sensed  by  a  device  called  a  ther¬ 
mistor.  It  responds  to  changes  in  temperature  by  a  change  of  resistance  in  the  sensing 
element.  Thermistors  can  be  as  small  as  0.005  in.  in  diameter  and  react  to  temperature 
changes  quickly.  Thus,  they  can  be  used  in  point  sensing.  However,  the  output  of  ther¬ 
mistors  is  nonlinear  with  temperature.  As  a  result,  the  computer  must  be  able  to  interpret 
the  output  with  the  response  curve  of  the  particular  thermistor. 

Thermocouples 

Thermocouples  have  been  used  as  temperature  sensors  for  years.  They  consist  of 
two  dissimilar  metals  which  are  in  thermal  and  electrical  contact.  As  the  temperature  in¬ 
creases,  the  output  of  the  thermocouple  increases,  but  nonlinearly.  Thermocouples  can  be 
made  very  small  and  cover  a  wide  range  of  temperatures.  However,  in  addition  to  nonlin¬ 
ear  output,  thermocouples  also  suffer  from  low  signal  outputs. 

3.4  Computer  Hardware 
3.4.1  Buses 

Buses  carry  and  link  information  between  the  components  or  between  subsystems. 
When  selecting  a  bus  system,  several  factors  should  be  considered.  Preferable  character¬ 
istics  include  [Tooley,  1988]: 

•  Industry-standard  architecture 
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High  data  transfer  rate 


•  Support  of  a  wide  range  of  processors  (8-,  1 6-  and  32-bit  types) 

•  Standard  size 

VME,  STE  and  PCI  form  the  standard  buses  currently  used  in  control  systems. 

VME  Bus 

VME  bus  supports  fast  data  transfer  rates  and  uses  a  single  connector  to  provide  a 
16-bit  data  path.  In  the  case  of  the  extended  bus  which  supports  32-bit  address,  a  second 
connector  is  used.  However,  the  VME  bus  may  be  considered  expensive  for  simpler  ap¬ 
plications. 

STE  Bus 

One  of  the  advantages  of  the  STE  bus  is  that  the  bus  signals  and  protocol  are 
standardized.  Various  processors  from  different  manufacturers  can  be  implemented  in  the 
system.  Thus,  the  designer  can  be  confident  in  interconnecting  STE  bus  products  from 
different  companies. 

PC  Bus 

Industry-standard  PCI  specifications  have  recently  emerged  and  been  supported 
by  PC-compatible  computers  and  PowerMacs.  Hence,  the  new  systems  targeting  PC  plat¬ 
forms  should  consider  the  PCI  architecture. 
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3.5  Computer  Interface 

An  interface  represents  a  connection  between  a  computer  and  other  components  in 
the  system.  In  the  field  of  robotics  and  telesensation,  the  computer  interface  is  very  im¬ 
portant  as  the  control  system  must  be  accurate  and  fast.  The  computer  interfaces  dis¬ 
cussed  here  are  actuator  controllers  and  A/D,  D/A,  D/D  converters. 

3.5.1  Actuator  Controller 

The  controller  of  actuators  can  have  various  control  methods.  Two  of  the  most 
popular  control  methods  used  in  industry  today  are  standalone  and  bus-based  architec¬ 
tures  whose  main  advantages  and  disadvantages  are  described  in  the  following  sections. 

Standalone 

This  type  of  controller  operates  without  the  need  for  data  or  other  control  signals 
from  elsewhere.  A  standalone  unit  usually  consists  of  a  keypad  for  data  entry  and  a  sim¬ 
ple  display  device.  Since  the  unit  is  unique,  it  has  its  own  commands  which  vary  from 
manufacturer  to  manufacturer.  Although  some  of  the  products  include  more  than  100 
commands,  it  is  relatively  easy  to  write  elementary  programs  because  the  commands  are 
usually  word-descriptive. 

Bus-Based  Systems 

Bus-based  systems  are  considered  to  be  very  flexible  since  the  designer  is  open  to 
various  options  for  optimizing  the  performance  without  affecting  system  compatibility.  In 
addition,  since  the  system  comes  in  the  form  of  computer  cards,  the  users  are  able  to  keep 
up  with  the  rapid  improvement  in  technology  by  replacing  or  upgrading  the  old  card  in- 
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stead  of  changing  the  whole  system.  Thus,  time  is  conserved  and  obsolescence  is  pre¬ 
vented  with  relative  ease.  However,  one  of  the  disadvantages  of  the  bus-based  control 
system  is  related  to  the  integration  between  the  motion  and  I/O  structure.  It  is  necessary 
to  obtain  software  integration  of  different  programming  languages  for  different  cards 
(controllers). 

3.5.2  A/D,  D/A  and  D/D  Controllers 

Conversion  between  analog  and  digital  quantities  can  be  considered  as  the  heart  of 
computer  control  systems.  Since  most  of  the  natural  parameters  such  as  speed  and  dis¬ 
tance  are  analog,  in  order  to  use  a  computer  to  control  the  system,  it  must  first  convert 
these  quantities  into  digital  form  using  A/D  converters.  It  then  does  the  calculations,  con¬ 
verts  back  to  analog  signals  using  D/A  converters  and  then  sends  the  signals  back  to  the 
devices.  For  some  devices  such  as  encoders,  the  quantities  are  measured  in  digital  type, 
so  D/D  converters  are  used.  Some  of  the  most  important  features  when  selecting  these 
cards  are  high  speed,  low  noise  and  low  cost  [Hnatek,  1976], 

3.6  Computer  Software 

3.6.1  Supervisory  Interface  Software 

The  general  structure  of  the  software  structure  is  presented  in  Fig.  3-1.  Some  of  the  desir¬ 
able  aspects  of  the  interface  software  are  described  below. 
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Figure  3-1.  Teleoperation  System  Software  Structure 


Menu-Driven  Interface 

In  a  telesensation  system  or  an  advanced  teleoperator  system,  a  friendly  graphical 
user  interface  (GUI)  that  supports  a  menu-driven  windows  environment  is  a  very  impor¬ 
tant  element.  This  type  of  sophisticated  software  enhances  the  performance  of  the  opera¬ 
tor  to  accomplish  the  required  tasks  more  efficiently. 

Graphics  Window 

By  providing  graphics  window  displays  in  the  telesensation  system,  the  operator 
is  able  to  interface  with  the  remote  system  by  means  of  pictorial  communications  [Kim, 
1993].  The  purpose  of  the  graphics  system  is  not  only  for  the  use  of  control  interface,  but 
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also  for  off-line  task  analysis,  planning  and  animation  environment  for  sensor-based  mo¬ 
bile  robots  [Kim  et.  al.,  1993].  The  amount  of  detail  and  accuracy  in  the  displayed  model 
depend  on  the  fidelity  of  the  system.  The  fidelity  also  includes  the  smoothness  of  an  ani¬ 
mated  remote  manipulator  and  the  update  time  between  the  operator’s  motions  and  the 
simulation’s  motions  [Kim  and  Bejczy,  1991].  By  using  such  graphics  software,  the  mo¬ 
bile  robotic  systems  can  be  designed,  developed  and  operated  in  a  more  efficient  and  reli¬ 
able  fashion. 

In  the  past,  the  instability  of  the  visual  feedback  due  to  time  delay  can  be  avoided 
by  the  open-loop  control  strategy  called  “move  and  wait,”  wherein  the  operator  controls 
the  master  arm  and  waits  for  the  action  of  the  slave  system  over  the  round-trip  delay  time 
before  he/she  can  issue  another  command.  To  enhance  the  performance  of  the  bilateral 
teleoperator  system,  a  predictor  display  is  introduced  [Sheridan,  1993].  The  predictive 
display  technique  provides  a  real-time  computer  graphics  generation  and  a  detailed  dis¬ 
play  of  static  objects  from  the  delayed  video  in  predicting  the  robot  arm  motion  before 
the  actual  operations  occur  [Bejczy  et.  al.,  1990]. 

In  May  1993,  the  telerobotic  experiment  which  involved  the  Jet  Propulsion  Labo¬ 
ratory  (JPL)  as  the  simulated  ground  control  station  and,  2500  miles  away,  the  Goddard 
Space  Flight  Center  (GSFC)  as  the  remote  site  was  performed  using  a  high-fidelity  pre¬ 
dictive/preview  display  technique  [Kim  and  Bejczy,  1993].  The  experiment  successfully 
demonstrated  that  under  a  time  delay  of  several  seconds,  this  method  could  be  imple¬ 
mented  to  the  system  to  compensate  in  real  time  for  the  operator’s  visual  perception  of 
the  task. 
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3.6.2  Joystick  Control  Software 

Position  and  Force  Scaling 

This  type  of  joystick  control  software  allows  the  user  to  input  the  scaling  values 
of  position  and  force  reflection  between  the  joystick  and  the  manipulator.  In  the  position 
mode,  as  the  operator  moves  the  joystick  a  certain  distance,  the  manipulator  would  move 
according  to  the  set  scaling  value.  In  the  force  mode,  the  operator  is  able  to  input  the 
scaling  value  of  reflected  force  at  the  manual  controller.  For  instance,  when  the  robot  ex¬ 
periences  a  certain  amount  of  forces,  the  magnitude  of  the  reflected  force  is  scaled  by  the 
operator.  This  is  especially  important  to  prevent  fatigue.  This  flexibility  makes  it  possible 
to  accomplish  various  tasks  at  any  level  of  delicacy. 

Rereferencing 

As  the  operator  moves  the  joystick,  the  manipulator  moves  a  certain  distance. 
However,  in  order  to  move  the  manipulator  further,  the  operator  must  define  a  reference 
point  so  that  he/she  can  make  further  joystick  movements.  This  is  accomplished  by  tem¬ 
porarily  suspending  the  joystick/remote  system  connection,  moving  the  joystick  to  a  de¬ 
sirable  reference  position  within  its  workspace  and  then  establishing  the  connection  with 
the  remote  system.  This  can  be  achieved  by  placing  a  connect/disconnect  toggle  switch 
on  the  joystick. 

Joystick  Mechanism  Input-Output  and  Force  Equations 

The  joystick  input-output  motion  equations  and  force  reflection  equations  must  be 
written  and  carried  out  by  special  software.  This  software  computes  the  forward  and  in¬ 
verse  kinematic  analysis  of  the  manual  controller  and  remote  manipulator.  These  equa- 
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tions  should  be  written  as  efficiently  as  possible  so  that  they  can  be  used  in  real-time 
computer  control. 

3.6.3  VR  Control  Software 

One  of  the  main  advantages  in  implementing  VR  control  software  in  a  telesensa¬ 
tion  system  is  that  VR  is  capable  of  moving  the  human-robot  interface  to  a  new  intuitive 
and  user-friendly  level  [Davies,  1993].  The  interaction  between  human  and  computer  is 
much  more  perceptive  than  that  of  using  a  mouse  to  change  the  view  in  a  flat  screen  dis¬ 
play.  In  addition,  operators  become  familiar  with  the  environment  rapidly  and  require  lit¬ 
tle  instruction  in  how  to  use  the  system.  In  designing  the  VR  control  software,  a  main  re¬ 
quirement  is  that  the  tracking  of  the  user’s  head  must  be  accurate  in  terms  of  position  and 
orientation. 

Latency  and  Update  Rate 

Aside  from  the  accurate  tracking,  the  prime  considerations  of  the  system  designer 
are  minimizing  latency  and  maximizing  update  rate.  The  software  must  be  able  to  modify 
images  rapidly  and  keep  up  with  the  user’s  head  movements  [Sheridan,  1995].  Both  pa¬ 
rameters  are  the  indication  of  whether  a  VR  system  will  serve  as  a  useful  device  or  frus¬ 
trate  the  user  [Vince,  1995]. 

VR  Input  Capability 

The  interaction  between  the  operator  and  the  VR  system  can  be  made  through  an 
immersive  stereo  viewer  and  voice  input.  An  example  of  such  a  system  has  been  devel¬ 
oped  at  ACML  for  application  in  the  cleanup  of  massive  Underground  Storage  Tanks 
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(UST).  This  system  uses  audio  feedback  to  continuously  guide  the  operator  and  to  pro¬ 
vide  command  confirmation  [Miner  and  Stansfield,  1994]. 

3.7  Summary 

A  typical  teleoperation  system  consists  of  many  components.  Depending  on  how 
these  components  are  classified,  actuators,  transmission  systems,  sensors,  and  computer 
systems  are  always  parts  of  such  a  system. 

The  types  of  actuators  used  in  robotic  systems  are  determined  largely  from  the 
type  of  applications.  Hydraulic  actuators  are  generally  used  for  heavy-duty  applications 
such  as  under-water  operations  whereas  most  industrial  robot  systems  use  electric  actua¬ 
tors  for  clean,  precise  and  quiet  operations.  Also,  a  brushless  DC  servomotor  is  preferred 
if  maintenance  is  minimal.  As  for  pneumatic  actuators,  they  are  commonly  used  in  the 
gripper  mechanism  because  of  their  lightweight. 

Transmission  systems,  such  as  gears  and  linkages,  are  used  to  reduce  the  load  car¬ 
ried  by  the  actuators.  Gears  are  the  most  common  transmission  elements  since  they  can 
transmit  large  torques,  but  the  system  will  sustain  friction  and  backlash.  A  more  compact 
design  is  harmonic  drives  which  provide  high  gear  ratios  and  almost  zero  backlash.  Nev¬ 
ertheless,  harmonic  drives  suffer  from  friction  because  of  the  tight  mechanism. 

Sensors  are  also  important  elements  of  the  system.  They  provide  feedback  of  the 
system  to  the  operator.  Position  feedback  can  be  achieved  by  using  encoder  (incremental 
and  absolute)  or  resolver  whereas  velocity  feedback  is  available  through  the  use  of  ta¬ 
chometer.  Force  and  torque  sensors  provide  force  feedback  through  the  operator  by  at- 
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taching  the  device  at  the  wrist  of  the  robot.  In  addition,  with  the  use  of  thermistors  or 
thermocouples,  the  environment  temperature  can  be  perceived  at  the  operating  site. 

Computer  systems  are  always  a  major  factor  of  any  teleoperation  systems.  Com¬ 
puter  hardware  such  as  system  bus  which  carries  and  link  information  between  the  com¬ 
ponents  or  between  subsystems  must  be  carefully  selected.  Preferable  characteristics  are 
high  data  transfer  rate  and  standard  size.  The  standard  buses  used  in  control  systems  are 
usually  VME,  STE,  or  PCI. 

An  actuator  controller,  and  A/D,  D/A,  and  D/D  converters  provide  the  interface 
between  a  computer  and  other  components.  Two  of  the  most  popular  control  methods  are 
standalone  and  bus-based  systems  where  each  has  advantages  and  disadvantages  over  the 
other.  For  instance,  a  standalone  system  is  simple  to  use  but  incapable  of  handling  the 
changes  of  configurations  while  bus-based  systems  are  flexible  but  must  use  the  software 
compatible  with  the  cards. 

The  computer  software  in  the  teleoperation  system  is  divided  into  three  parts,  (i) 
supervisory  interface  software:  This  level  consists  of  menu-driven  interface  and  graphics 
window  to  provide  the  operator  with  a  friendly  user  interface,  (ii)  joystick  control  soft¬ 
ware:  The  position  and  force  scaling,  rereferencing,  and  joystick  mechanism  input-output 
and  force  equations  are  included  in  this  level.  This  level  attempts  to  provide  the  operator 
with  all  the  parameters  and  options  to  control  the  remote  system,  (iii)  VR  control  soft¬ 
ware:  The  software  must  minimize  latency  and  maximize  update  rate  and  provide  the  in¬ 
put  capabilities  such  as  voice  input  so  that  the  VR  unit  will  serve  as  a  useful  device,  not 
frustrate  the  user. 
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CHAPTER  4 


DESIGN  AND  DEVELOPMENT  OF  A  1-DOF  FRMC 

The  1-DOF  Force-Reflecting  Manual  Controller  (FRMC)  version  has  been  designed  and 
constructed  to  demonstrate  the  basic  principles  of  the  force-reflecting  teleoperation  sys¬ 
tem.  The  specifications  of  the  system  components  and  the  system  characteristics  are 
given  in  this  section.  In  addition,  the  system  parameters  are  identified  in  order  to  con¬ 
struct  a  mathematical  model.  This  model  will  be  used  to  test  different  control  methods  in 
the  next  chapter. 

4.1  1-DOF  FRMC  Components 

At  this  stage,  the  dimensions  of  the  system  is  not  a  concern  of  the  development  of 
the  1-DOF  FRMC  since  the  intention  here  is  to  establish  the  necessary  connection  and  to 
demonstrate  the  basic  principles  of  the  system.  Many  companies  have  been  contacted  to 
discuss  their  actuator  and  controller  systems.  Though  a  motor  from  one  company  can  be 
used  with  a  controller  from  the  other  company,  the  decision  was  made  to  purchase  the 
complete  system  from  a  single  company.  One  of  the  main  reasons  is  that  it  is  relatively 
easy  to  establish  the  connections  of  the  components  that  come  from  the  same  company 
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[Tosunoglu  et.  al.,  1996a],  Should  any  problems  arise,  they  can  be  resolved  with  relative 


ease. 

The  actuator  and  controller  systems,  which  included  a  rare-earth  permanent  mag¬ 
net  brushless  DC  servomotor  with  1000-line  encoder,  PC  bus-based  controller  with  PID 
feedback,  amplifier,  and  interface  board  were,  purchased  from  the  Aerotech  Company. 
Aerotech  was  selected  because  of  its  competitive  price  and  suitability  of  hardware  com¬ 
ponents.  Other  components  comprising  the  1-DOF  FRMC  include  force/torque  sensor 
and  processor.  The  industrial  robot  PUMA  760  is  used  to  simulate  the  robotic  device  at  a 
remote  site.  Table  4-1  provides  a  summary  of  the  purchased  hardware  components  and 
software  for  the  1-DOF  FRMC  whereas  Figure  4-1  shows  the  system  components.  The 
specifications  of  each  item  are  given  in  the  relevant  section  below. 


Table  4-1.  Listing  of  Hardware/Software  Components  for  1-DOF  FRMC  System 


Components 

Model 

Company 

Brushless  DC  servomotor 

BM200 

Aerotech 

Encoder 

MS-E1000H 

Aerotech 

Controller 

UNIDEX500 

Aerotech 

Amplifier 

BA20 

Aerotech 

Interface  Board 

BB501 

Aerotech 

Force/Torque  Sensor 

100M40A-U760 

JR3 

ISA-Bus  Receiver/Processor 

P/n  1523 

JR3 

Control  Software 

C++  4.0 

Borland 

Computer 

IBM  Pentium  166  MHz. 

Dell 

Remote  System  Industrial  Robot 

PUMA  760  6-DOF  Robot 

Unimation 
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Figure  4-1.  1-DOF  FRMC  Components 


Actuator 

In  the  past  decade,  the  technological  development  of  motors  has  been  greatly  im¬ 
proved.  High-performance  motors  become  smaller  and  better.  This  results  from  using  the 
latest  magnet  materials  which  are  Samarium  Cobalt  and  Neodymium  magnets,  also 
known  as  “Rare-Earth”  magnets.  These  types  of  permanent  magnet  materials  are  classi¬ 
fied  as  the  highest  available  energy  product.  Less  amount  of  material  is  used  in  producing 
high-performance  motors.  Thus,  the  sizes  of  the  rare-earth  magnet  motors  are  relatively 
smaller  than  the  other  magnet  material  types  such  as  Ferrite  or  Alnico. 

The  motor  used  in  the  1-DOF  FRMC  is  made  from  rare-earth  neodymium  mag¬ 
nets.  Therefore,  the  dimension  of  the  system  is  relatively  compact.  The  motor  is  attached 


to  a  1000  line  encoder.  The  detailed  specifications  of  the  motor  and  encoder  are  given  in 
Table  4-2  and  4-3,  respectively. 


Table  4-2.  BM  200  Brushless  Servo  Motor  Specifications 


Parameters 

Values 

Continuous  Stall  Torque 

200  oz-in 

Peak  Torque 

500  oz-in 

Maximum  Speed 

8000  rpm 

Rated  Speed 

4000  rpm 

Rated  Power 

0.60  hp 

Torque  Constant  (Stall) 

28.6  oz-in/amp  (RMS) 

Maximum  Continuous  Stall  Current 

10  A 

Continuous  Stall  Current 

7  A 

Maximum  Peak  Current 

30  A 

RMS  Peak  Current 

21  A 

Back  EMF  Constant  (line-line) 

17.2  Volt  (peak)/krpm 

Terminal  Resistance  (line-line) 

1.1  ohms  (cold) 

Armature  Inductance  (line-line) 

1.1  mH 

Inertia 

0.00 1 9  (oz-in-sec2) 

Maximum  Acceleration 

270000  rad/sec2 

Motor  Constant 

19  oz-in/wattI/2 

Static  Friction  Torque 

4  oz-in 

Maximum  Armature  Temperature 

155  °C 

Electrical  Time  Constant 

1.1  msec 

Thermal  Time  Constant 

12  min 

Thermal  Resistance 

109  °C/watt 

Maximum  Radial  Load 

20  lb 

Maximum  Axial  Load 

201b  1 

Motor  Weight 

(includes  encoder  and  end  cover) 

4.3  lb 
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Table  4-3.  Encoder  Specifications 


Parameters 

Values 

Input  Power 

5  VDC  @  400  mA  max 

Sink/Source  Current 

20  mA 

Output  Configuration 

Differential  line  driver  (26LS3 1) 

Output  Frequency 

100  KHz  (all  channels) 

Operating  Temperature 

-10°C-85°C 

Storage  Temperature 

-30°C-  100°C 

Resolution 

1000  Cycles/Rev 

Commutation 

4  Cycles/Rev 

Amplifier 

The  brushless  servo  amplifier  for  this  1-DOF  FRMC  is  the  model  BA20  from 
Aerotech,  Inc.  The  BA  amplifiers  can  be  integrated  into  a  system  using  three  basic  con¬ 
figurations;  velocity  command,  current  command,  and  dual-phase  command.  In  the  ve¬ 
locity  command  configuration,  the  speed  of  the  motor  is  controlled  by  the  amplifier.  A 
feedback  signal  from  encoder  is  monitored  by  the  amplifier.  From  this  signal,  the  ampli¬ 
fier  adjusts  the  velocity  of  the  motor  accordingly  depending  upon  the  velocity  command 
from  the  external  controller.  In  this  configuration,  the  amplifier  closes  and  controls  the 
velocity  loop.  In  the  current  command  configuration,  the  output  current  to  the  motor  is 
proportional  to  the  current  command  input.  The  advantage  to  this  configuration  is  the  sine 
and  cosine  signals  sent  to  the  amplifier;  therefore,  a  tachometer  is  not  required.  Finally, 
the  dual-phase  command  configuration  is  used  in  the  1-DOF  FRMC.  In  this  mode,  the 
differential  input,  pre-amplifier,  and  self-commutation  circuits  are  bypassed.  The  dual- 


49 


phase  inputs  which  are  sinusoidal  are  120°  out  of  phase  from  each  other.  The  third  phase 
is  generated  by  the  amplifier.  The  advantage  of  this  configuration  is  that  it  provides  the 
smoothest  possible  motion. 

The  specifications  of  this  amplifier  are  given  in  Table  4-4. 


Table  4-4.  BA20  Amplifier  Specifications 


Parameters 

Values 

Standard  Voltage  Configuration 

160  V 

Peak  Output  Current 

20  A 

Continuous  Output  Current  (peak) 

10  A 

DC  Bus  Voltage  Range  (Nominal  VDC) 

80-160  V 

Controller 

The  UNIDEX  500  (U500)  base  model  is  the  basic  version  of  the  U500  PC  bus- 
based  controller  from  Aerotech  Inc.  The  servo  control  system  includes: 

•  24-bit  DSP  processor 

•  0.24  msec  simultaneous  update  rate  for  all  axes 

•  Lead  error  correction  and  multi-dimensional  error  mapping 

•  Dual-loop  positioning  to  eliminate  effects  of  VGA  backlash  and  other  forms 
of  lost  motion 

Detailed  specifications  are  given  in  Table  4-5. 
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Table  4-5.  U500  Controller  Specifications 


Axes 

1  to  4  axes  per  card 

Processor 

40  Mhz,  DSP 

Axis  Loop  Type/ 
Update  Rate 

PID  with  velocity  and  acceleration  feedforward;  less  than  250 
psec  total  update  for  all  four  axes 

On-board  Memory 

384  KB  RAM  for  firmware,  data  storage  and  user  queue 

Bus  Compatibility 

ISA  bus  specification,  full-length  standard  AT  format  card 

Acceleration  Profiles 

Linear,  parabolic  and  custom  profiles  (1  msec  to  32.768  sec) 

Process  Time 

Command  execution  *  1  msec;  read  request  1 .6-2  msec 

Position  Feedback 

•  Resolution  -  Incremental  encoder,  times-4  multiplying 

•  Accuracy/Repeatability  -  +/-  'A  count  of  multiplied  feedback  transducer  signal 

•  Independent  Motions 

•  Coordinated  Motions 

•  Interpolated  Motions  - 

Motion  Types 

-  Point-to-point  incremental;  target  position  or  velocity  profiles; 
time  based;  free  run 

-  Advanced  queuing  and  deferred  execution  features  for 
simultaneous  command  execution 

-  Four  axis  linear  interpolation;  velocity  profiling;  comer 
rounding 

•  Digitally  Geared  Motions  -  1:1  master/slave;  n:n  gear  ratio  for  1  master  and  up  to 

3  slaves  or  2  masters  with  1  slave  each 

•  Trajectory  Adjustment  -  On-the-fly  trajectory  modification 

Range  Limits 

•  Position  -  247  -  1  counts 

•  Velocity  -  215  steps/msec 

•  Acceleration  -  2 15  steps/msec2 

Programming 

•  Languages  -  Hard-coded  machine  tool  G-code  (RS-274),  equivalent  BASIC-like  and 

‘C’  function  calls  (via  software) 

•  Software  Compatibility  -  ‘C\  Visual  Basic,  QuickBASIC;  32-bit  ‘Quick  Libraries’ 

available  for  direct  DSP  manipulation 
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Interface  Board 


The  BB501  interface  board  provides  the  ability  to  interface  the  U500  control 
board  to  the  BA20  amplifier.  This  board  provides  two  U500  interface  connectors,  four 
axes  of  amplifier  and  feedback  connectors,  one  joystick  port,  three  I/O  connectors,  one 
D/A  connector,  one  brake  connector  and  an  external  power  supply  connector.  Also  con¬ 
tained  on  this  board  are  several  jumpers  that  permit  the  BB501  to  be  configured  for  dif¬ 
ferent  options  and  hardware. . 

The  BB501  interface  board  requires  +5  V  at  less  than  0.1  A  which  it  obtains 
through  the  main  signal  connector.  An  additional  5  V  supply  may  be  required  to  power 
the  encoder  and  limit  circuitry  if  the  amplifiers  are  not  capable  of  supplying  the  current. 
If  an  external  power  supply  is  required,  it  should  meet  the  following  minimum  require¬ 
ments. 

Current  capacity  requirement  for  a  typical  system  is  represented  in  Table  4-6. 
However,  some  systems  may  require  higher  amperage  supplies. 


Table  4-6.  Current  Capacity  Requirement  for  the  BB501  Interface  Board 


Parameter 

Values 

Power  Supply  Requirements 

+5  V 

Nominal  Voltage  (min.-  max.) 

4.9  V  -  5.25  V 

Ripple  (P-P  volts) 

less  than  100  mV  P-P 

Current  Capacity 

0.5  A/axis  minimum 
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Force/Torque  Sensor 

The  force/torque  (F/T)  sensor  model  100M40A-U760  50L200  was  obtained  from 
JR3,  Inc.  It  is  a  six-axis  force  and  torque  transducer  with  a  force-measuring  capacity  of 
50  lbs,  and  a  torque-measuring  capacity  of  200  lb-in.  The  cylindrical  unit  is  100  mm  in 
diameter,  40  mm  high  and  weighs  1 .4  lb.  It  has  captive  bolts  which  allow  direct  connec¬ 
tion  to  the  Staubli  Unimation  Puma  760  robot.  The  100M40  model  uses  metal  foil  strain 
gages  bonded  to  strain  rings  as  the  sensing  element  which  produces  linear  outputs.  It  has 
signal-conditioning  electronics  integrated  into  the  sensor  body.  Included  in  the  electron¬ 
ics  are  amplifiers,  and  analog  to  digital  converter  (A/D),  and  EEPROM  containing  cali¬ 
bration  data  and  RS-485  serial  drivers.  The  1 00M40  outputs  a  2  megabit  per  second  serial 
data  stream  which  contains  complete  6  axis  data  at  8  kHz  and  can  be  read  by  ISA  (IBM- 
AT)  bus  receiver/processor. 

The  ISA-bus  receiver  uses  the  cable  to  provide  power  to  the  sensor,  as  well  as  to 
receive  the  high-speed  serial  data  from  the  sensor.  The  ISA-bus  receiver  requires  no  ex¬ 
ternal  power.  It  draws  power  directly  from  the  ISA  bus.  The  receiver  uses  the  following 
voltage  and  currents: 

5  V:  650  mA  typical 

12  V:  25  mA  typical  (without  sensor) 

- 1 2  V:  5  mA  typical  (without  sensor) 

The  sensor  will  also  draw  anywhere  from  200  to  400  mA  from  the  +12  V,  and 
possibly  as  much  as  100  mA  form  the  -12  V. 

The  ISA-bus  receiver  uses  an  Analog  Devices  ADSP-2105,  a  10  Mips  digital  sig¬ 
nal  processing  chip.  This  chip  has  the  ability  to  provide  decoupled  and  filtered  data  at  8 
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kHz  per  axis.  Some  of  the  signal  processing  functions  performed  by  the  ISA-bus  receiver 
include:  decoupling,  coordinate  transformation  (translation  and  rotation),  low-pass  filter¬ 
ing,  vector  magnitude  calculation,  maximum  and  minimum  peak  capture,  threshold 
monitoring,  and  rate  calculations. 

The  ISA-bus  receiver  communicates  to  the  host  computer  through  two  16-bit  I/O 
ports.  Using  the  I/O  ports,  the  host  computer  reads  directly  from  a  dual-port  RAM. 

The  general  specifications  of  this  force/torque  sensor  are  given  in  Table  4-7. 


Table  4-7.  100M40A-U760  Force/Torque  Sensor  Specifications 


Parameter 

Fx>  Fy 

Fz 

Mx,  My 

Mz 

Capacities  (lb,  in-lb) 

50 

100 

200 

200 

Resolutions  (lb,  in-lb) 

0.013 

0.05 

0.05 

0.05 

Stiffness  (klb/in,  kin-lb/rad) 

130 

1350 

1950 

650 

Permissible  Single  Axis  Overloads  (lb,  in-lb) 

590 

2000 

1700 

1500 

PUMA  760  Robot 

For  the  purpose  of  the  experiment  and  evaluation  of  the  1-DOF  FRMC,  the 
PUMA  760  industrial  robot  is  used  to  simulate  the  remote  site.  The  PUMA  760  robot  is  a 
member  of  the  Unimate  PUMA  700  series  robot  manufactured  by  Unimation,  a  Westing- 
house  Company,  of  Danbury,  Connecticut  (recently  newer  models  produced  by  Staubli). 
The  robot  consists  of  six  revolute  joints  which  are  driven  by  permanent-magnet  servo¬ 
motors.  It  weighs  640  pounds  (290  kg)  and  has  a  maximum  static  payload  of  10  kg.  The 
PUMA  760  workspace  is  1.25  meters  (spherical  volume)  with  the  shoulder  at  the  center. 
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The  system  software  that  controls  the  robot  is  called  VAL.  VAL  is  a  high-level 
language  that  is  specially  designed  for  the  use  of  the  Unimation  industrial  robots.  It  pro¬ 
vides  the  ability  to  define  the  tasks  that  robots  perform  either  task  by  task  (single  line 
command)  or  as  a  complete  program.  Real-time  computations  are  performed  during  the 
actual  running  of  the  robot  program  to  convert  the  stored  data  to  position  information. 

4.2  System  Setup  and  System  Characteristics 

The  setup  of  1-DOF  FRMC  is  shown  in  Figure  4-2.  The  principle  of  the  control 
system  can  be  summarized  as  follows.  First,  the  joystick  is  used  to  control  the  motion  of 
the  robot.  The  control  software  reads  in  the  amount  of  the  joystick  movement  and  com¬ 
putes  the  data  according  to  the  operation  parameters  such  as  control  modes  (position  or 
velocity),  scaling  values  for  position  or  velocity  and  re-referencing  parameters  which  are 
input  by  the  user. 

Forces  experienced  by  the  manipulator  are  received  through  the  Force/Torque 
(F/T)  sensor.  The  F/T  driver  receives  the  signals,  processes  the  data  and  transmits  it  to  the 
control  software.  The  control  software  carries  out  the  calculations  such  as  force  feedback 
scaling,  position  scaling,  etc.  Once  the  calculations  are  completed,  the  program  sends  the 
data  to  the  controller,  U500,  which  accepts  high-level  commands.  The  controller  then 
computes  the  necessary  torque  needed  and  passes  the  signals  as  low-level  command  sig¬ 
nals  to  the  interface  board,  BB501.  The  interface  board  BB501  on  the  other  end  is  con¬ 
nected  to  the  amplifier  BA20  which  is  used  to  amplify  the  signal  and  deliver  the  power  to 
operate  the  motor.  The  motor  drives  the  joystick  that  is  attached  directly  to  the  motor. 
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PC-IBM  Pentium  166  MHz 


Figure  4-2.  Setup  of  1-DOF  FRMC  Testbed 


For  the  setup  shown  in  Figure  4-2,  the  system  is  able  to  provide  a  peak  torque  of 
404  oz-in.  With  the  length  of  the  handgrip  of  5  in,  the  1  -DOF  FRMC  prototype  can  pro¬ 
duce  a  maximum  force  reflection  of  5  lb.  The  update  rate  of  the  system  is  approximately 
0.002  sec  or  500  Hz.  Note  that  the  system  is  set  up  in  the  form  of  direct-drive  configura¬ 
tion.  Therefore,  more  force  reflection  can  be  obtained  by  implementing  a  gear  set  to  the 
system.  However,  the  system  will  sustain  higher  friction  and  backlash  as  a  result  of  using 
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a  gear  system. 


4.3  System  Identification 

The  main  purpose  of  constructing  a  model  is  to  predict  the  output  of  the  system. 
Also,  a  mathematical  model  is  a  useful  tool  to  prevent  damages  to  the  system  that  result 
from  unexpected  system  response.  In  addition,  it  serves  as  a  means  to  experiment  for 
various  control  schemes  such  as  PID,  fuzzy  logic,  adaptive,  neural  and  other  emerging 
controller. 

The  system  identification  is  the  process  of  estimating  a  model  of  a  system  based 
on  observed  input-output  data.  According  to  Ljung,  a  mathematical  model  can  never  be 
used  to  represent  the  true  description  of  the  system,  but  rather  it  can  be  best  regarded  as  a 
sufficient  description  of  certain  aspects  that  are  of  particular  interest  [Ljung,  1987]. 

The  following  are  the  common  procedures  that  are  used  to  carry  out  the  system 
identification  process  [Hsia,  1977]. 

1 .  Select  a  set  of  candidate  models  that  represents  the  system  to  be  identified. 

2.  Apply  an  appropriate  test  signal  (input)  and  collect  the  data  (output). 

3.  Perform  the  parameter  identification  to  select  the  suitable  model. 

4.  Perform  the  model  validation. 

5.  The  process  ends  if  the  model  is  valid.  If  not,  another  set  of  candidate  models  will 

be  selected.  Repeat  steps  2-4  until  the  model  is  valid. 

The  choice  of  an  identification  method  and  the  type  of  a  model  depend  on  the  nature 
of  the  system  and  the  purpose  of  identification.  Parametric  system  models  are  usually 
more  preferable  than  nonparametric  models  because  modem  control  theory  and  system 
design  techniques  require  the  state  variable  description  of  the  system  dynamics  [Hsia, 
1977].  As  for  the  choices  between  discrete  and  continuous  models,  it  is  more  practical  to 
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estimate  the  system  as  a  discrete  model  since  digital  computers  are  commonly  used  to 
control  and  store  the  data  in  discrete  forms.  In  addition,  difference  equations  are  easier  to 
manipulate  and  identify  than  differential  equations. 

For  a  parametric,  single-variable,  linear,  time-invariant  discrete  system,  the  input- 
output  relationship  can  be  represented  by  an  nth  order  linear  difference  equation: 

;>(£)  +  aiy{k  - 1)+ . +a„y(k  -  n)  -  b0u(k)  +  btu(k  - 1)+ . +b„u(k  -n)  +  e{k)  (4.1) 

where  y(k)  and  u(k)  are  the  measured  output  and  input  data,  respectively. 

Equation  (4.1)  can  be  written  as: 

A(q~')y{k)  =  B[q-')u{k)  +  e{k)  (4.2) 

where 

A(q-')=\  +  axq-'+ . +amq~m 

B(q-')  =  b0+biq-'+ . +bnq-" 

The  transfer  function  of  this  system  is  defined  by: 


G(z)> 


£1 

4") 


(4.3) 


Equation  (4.1)  is  also  referred  to  as  the  ARX  model  (AR  refers  to  the  autoregressive  part 
A(q’l)y(k)  and  X  to  the  extra  input  B(q‘')u(k)). 

The  a,  and  bj  terms  of  the  ARX  model  are  estimated  using  the  least  squares  esti¬ 
mation  method.  This  method  is  described  as  follows  [Hsia,  1977], 

Equation  (4.2)  is  rewritten  as: 


58 


(4.4) 


y(k) = -E  a<y{k  - 0 +  S  ^  «(*  -  0 + «(*) 

i=l  i=0 


Defining  the  2n+l  input-output  vector  jc (t)  as 


x(k)  =  [-y(£  - 1), . ,-y(k  -  n),  u(k), . ,u(k-  «)]r 

the  n  parameter  vector  0  as 


0  =  [a.» . >an>bo> . 


Equation  (4.4)  becomes 


y(k)  =  xT(k)9+e{k) 


(4.5) 


This  can  be  set  up  as  a  system  of  N  equations  (for  k  =  1, ,  (N+n))  as 


y  =  X9  +  e 


(4.6) 


where 


y  =  [y(n  +\),y(n  +  2), . y(n  +  iV)]r 

e  =  Je(«  +  l),  e(n  +  2), . ,  e(n  +  iV)Jr 


V(*  +  l)’ 

-y(n)> . . 

-#)> 

u(n  +  l),.. 

A  i)  1 

xT(n+ 2) 

— 

-X"+1)> . » 

-y(2). 

u(n+ 2),.. 

-A2) 

xT(n  +  N ) 

-y(n  +  N- 1), . , 

-m 

u(n  +  N),... 

■A»)_ 
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Using  the  vector  Equation  (4.6),  in  which y  and  X are  given,  9 can  be  estimated  by 
means  of  least  squares.  This  approach  was  first  derived  by  Guass.  The  complete  solution 
is  provided  below. 

The  least-squares  method  states  that  the  estimate  0is  chosen  so  that  the  value  of  9 
minimizes  the  error  function  J: 

N+n 

J=  Yje2(k)  =  eTe 

k*n+ 1 

=  {y-M)T{y-xe)  (4.7) 

Upon  setting 

^  =0 
39  e-'e 

the  least-squares  estimate  9  can  be  obtained  by: 

e  =  (xrx]'x,y 

assuming  that  XTX  is  nonsingular. 

To  obtain  sufficiently  rich  output  that  contains  the  maximum  information  about 
the  dynamic  modes  of  the  system,  the  system  must  be  excited  with  frequencies  that  span 
a  wide  range.  Under  these  conditions,  the  parameters  can  be  estimated  with  high  accu¬ 
racy.  For  the  particular  system  at  hand,  the  maximum  input  voltage  that  can  be  applied  is 
limited  between  -10  to  10  volts.  To  achieve  these  limits,  the  system  was  excited  in  the 
open-loop  environment  by  a  sinusoidal  signal  with  a  frequency  of  7  Hz  and  sampling 
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time  of  0.001  second.  Figure  4-3  shows  the  measured  input-output  data  collected  from 
the  system. 


OUTPUT  #1 


Figure  4-3.  Input-Output  Data  Collected  from  the  System 


Figure  4-4  shows  the  comparison  of  the  output  obtained  from  the  actual  system 
and  from  different  models  that  is  described  by  different  order  systems  represented  by 
transfer  function  in  Table  4-8. 
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Table  4-8.  Models  Represented  by  2nd,  3rd,  and  4th  Order  Systems 


Model 

Transfer  Function 

2nd-Order 

0.0296s +  0.042 

sJ  +  1.8944i  +  0.8950 

3rd-Order 

/X  0.0 Is2  +  0.001s +  0.008 

^  “  s3  +  2.9438s2  +  2.9174s  +  0.9736 

4th-Order 

/  x  _  0.02533s3  +  0.0473s:  +  0.0937s  +  0.01336 
^  s*  +  3.366s3  +  4.1777s2  +  2.2397s  +  0.428 

- Output  ;  - 2  nd  Order;  -  3  rd  Order;  - 4  *  Order 


Figure  4-4.  Comparison  of  the  Actual  System  Response  with  2nd-,  3rd-,  and  4Ul-Order 

Model  Outputs 
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As  can  be  seen,  the  2nd-  and  3rd-order  models  produce  output  that  match  the  actual 
system  output  fairly  well  whereas  the  4th-order  model  tails  away  at  the  end.  Thus,  either 
the  2nd-  or  3rd-order  system  can  be  used  as  a  model  for  this  system.  For  simplicity,  the 
2nd-order  model  is  used  to  represent  the  1-DOF  FRMC  prototype  system  dynamics. 
Therefore,  the  selected  model  is  represented  as 

\  _  0.02963  +  0.042 

j2  +  1.8944^  +  0.8950  (  ) 

4.4  Model  Validation 

To  verify  the  accuracy  of  the  model,  the  servo  loop  of  the  U500  controller  was 
numerically  simulated  on  the  computer.  Figure  4-5  illustrates  the  U500  servo  loop  where 
Kp  is  Proportional  Gain 
Ki  is  Integral  Gain 
Kd  is  Derivative  Gain 
Vffis  Velocity  Feedforward  Gain 
Aff  is  Acceleration  Feedforward  Gain 
F,  is  Sampling  Frequency 

Further  details  of  the  U500  control  scheme  are  discussed  in  the  next  chapter. 
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The  control  method  of  the  U500  controller  is  based  on  the  traditional  PID  feed¬ 
back  with  velocity  and  acceleration  feedforward  loops.  It  uses  a  dual  control  loop  having 
an  inner  velocity  loop  and  an  outer  position  loop.  The  block  diagram  was  created  using 
the  SIMULINK  program  to  represent  the  servo  loop  of  the  U500  controller.  Figures  4-6, 
4-7,  and  4-8  compare  the  system  response  between  the  model  and  the  actual  system  of 
different  gains  represented  in  Table  4-9.  The  sampling  time  in  this  experiment  is  0.001 
second  whereas  the  amplifier  block  is  modeled  as  a  gain  whose  value  is  set  to  100. 

Table  4-9.  Gains  Used  in  the  System  Identification  Process 


KP 

K, 

Kd 

ID1 

4 

10,000 

20,000 

ID2 

8 

30,000 

20,000 

ID3 

10 

20,000 

40,000 

Figure  4-6.  Comparison  of  the  System  Response  between  the  Model  and  Actual  System 

for  the  Gain  Set  ID1 
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Figure  4-7.  Comparison  of  the  System  Response  between  the  Model  and  Actual  System 

for  the  Gain  Set  ID2 


Figure  4-8.  Comparison  of  the  System  Response  between  the  Model  and  Actual  System 

Output  for  the  Gain  Set  ID3 

In  Figures  4-6  and  4-7,  the  model  does  not  yield  the  output  that  matches  exactly 
with  the  actual  system  response.  However,  it  displays  similar  behavior  which  is  consid¬ 
ered  as  the  most  important  aspect  when  constructing  the  model.  The  discrepancy  between 
the  model  response  and  the  actual  system  output  can  be  explained  by  unmodeled  friction 


and  unmodeled  high-frequency,  low-magnitude  system  dynamics.  Because  the  FRMC 
system  is  direct-drive  and  has  only  one  degree  of  freedom,  the  friction  is  minimal  and 
omitted  in  the  model  [Batsomboon  et.  al.,  1998].  With  a  better  set  of  gains,  ID3,  Figure  8 
shows  that  the  model  is  able  to  produce  the  result  that  closely  matches  the  actual  system 
response.  Therefore,  it  can  be  concluded  that  the  second-order  model  obtained  in  the  pre¬ 
vious  section  is  sufficiently  accurate  to  represent  the  actual  system  to  test  the  perform¬ 
ance  of  various  controllers. 
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CHAPTER  5 

TESTING  AND  EVALUATION  OF  CONTROL  METHODS  FOR 
THE  1-DOF  FORCE-REFLECTING  MANUAL  CONTROLLER 

In  this  chapter,  two  control  algorithms  are  experimentally  tested  on  the  1-DOF  FRMC 
testbed.  These  two  control  methods  are  (1)  the  PID  feedback  with  velocity,  and  accelera¬ 
tion  feedforward,  and  (2)  fuzzy  logic  controller.  The  response  of  the  system  of  each  of 
the  methods  is  analyzed  and  evaluated.  Numerical  simulation  results  obtained  from  the 
mathematical  model  are  compared  with  that  of  experimental  data  for  both  types  of  con¬ 
trollers. 

5.1  PID  Controller 

The  PID  controller  discussed  in  this  section  uses  the  control  loops  as  presented  in 
the  previous  chapter.  The  control  loop  is  shown  again  here  in  Figure  5-1. 
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As  stated  earlier,  the  control  method  of  the  U500  controller  is  the  P1D  with  veloc¬ 
ity  and  acceleration  feedforward.  It  uses  a  dual  control  loop  having  an  inner  velocity  loop 
and  an  outer  position  loop.  The  system  performance  can  be  obtained  in  two  distinct  as¬ 
pects:  First,  the  attempt  to  obtain  the  smallest  amount  of  position  etror  that  is  allowable 
by  pre-defined  tolerances  and  has  smooth  motion.  Second,  the  attempt  to  obtain  the 
smallest  amount  of  position  error  that  is  allowable  by  pre-defined  tolerances  and  have 
-trim.!  settling  time  with  no  concern  of  smoothness  of  motion,  the  optimal  perform- 
ance,  therefore,  would  be  to  combine  both  aspects. 

5.1.1  Simulation  of  FID  Controller 

PID  controller  simulation  is  performed  by  developing  a  C  program  in  an  attempt 
to  mimic  the  PID  of  U500  controller.  Using  the  mathematical  model  obtained  m  the  pre¬ 
vious  section, 
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G(s)  = 


0.02965  +  0.042 
s2+ 1.89445  +  0.8950 


the  above  equation  can  be  written  as 

(52  +1.89445  +  0.8950 )f(j)  =  (0.02965  +  0.042)x(j) 
Equation  (5.1)  is  transformed  to  differential  equation  as 

y  + 1 .8944 y  +  0.8950y  =  0.0296x  +  0.042x  =  u 
According  to  the  Figure  5-1,  u  (input  torque)  is  represented  as 


(5.1) 


(5.2) 


u  -  y  + 


e* 


'Kp*m 

4096 


+  e 


(  Kd*\0 
8,388,608 )  l  8 


1,388,608  J  J 


e* 


Kp  *10' 
4096 


\  +  e 


dt  (5.3) 


Equation  (5.2)  is  written  in  the  form  of  two  first-order  differential  equations  as 


=  *2  =  y 

x2=y  =  -l  .8944 y  -  0.8950 y  +  u 


(5.4) 


or 


x,  =x2 


x2  =-0.8950x.  -1.8944 x,+u 


With  these  two  first-order  differential  equations,  the  system  response  is  obtained 
from  the  C  program  simulation  by  numerical  integration.  Figure  5-2  shows  one  of  the 
simulated  results  for  the  set  of  gains  of  KP  =  10,  Ki  =  28,000,  and  KD  =  40,000.  In  this 
simulation,  parabolic  function  input  is  used  as  the  desired  path  instead  of  the  step  input. 
The  reason  is  that  the  ramp  input  does  not  create  large  errors  initially  as  in  the  case  of 
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step  input.  As  a  result,  this  eliminates  undesired  system  response  due  to  system  shocks 
introduced  by  a  large  difference  between  the  actual  and  desired  inputs.  This  process  pro¬ 
vides  a  realistic  situation  where  the  smoothness  of  the  system  is  one  of  the  desired  char¬ 
acteristics  of  the  FRMC  performance.  As  can  be  seen  in  Figure  5-2,  the  model  follows 
the  desired  path  fairly  well  without  oscillations  or  any  deviation  away  from  the  desired 
behavior.  Transient  response  as  well  as  the  steady-state  response  are  observed  to  be  quite 
acceptable. 


Figure  5-2.  Simulated  System  Response  under  PID  Controller 
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5.1.2  Experiments  on  1-DOF  FRMC  by  Implementing  the  PID  Controller 

As  one  knows,  the  objective  of  a  PID  controller  is  to  determine  the  values  of  the 
three  gains,  Kp,  Ki,  and  Kd,  so  that  the  performance  of  the  system  meets  the  design  re¬ 
quirements.  Here,  the  subscript  P  stands  for  “proportional,”  I  for  “integral,”  and  D  for 
“derivative”  to  indicate  various  gains  used  in  the  feedback  loops.  In  this  section,  different 
gains  are  tested  experimentally  to  obtain  the  best  possible  system  response.  Although  the 
simulations  of  the  PID  controller  have  been  performed  earlier,  the  real-life  situations  of¬ 
ten  give  different  results  because  of  the  unmodeled  dynamics  in  the  simplified  system 
model. 

Figures  5-3,  5-4,  and  5-5  show  some  of  the  system  responses  of  the  gains  in  Table 
5-1  versus  system  position  command  where  the  plots  on  the  left  side  provide  the  entire 
view  of  system  response  and  the  plots  on  the  right  focus  on  the  steady-state  portion.  Fig¬ 
ure  5-6  compares  the  system  response  errors  in  these  experiments. 


Table  5-1.  Gains  Used  in  Experiments  on  the  Actual  System 


KP 

K, 

Kd 

PID1 

10 

28,000 

40,000 

PID2 

2 

20,000 

40,000 

PID3 

4 

20,000 

40,000 

PID4 

2 

10,000 

10,000 

PID5 

12 

10,000 

10,000 

PID6 

8 

30,000 

20,000 
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Figure  5-3.  Position  Command  and  System  Response  of  PID1  Gains 


Figure  5-4.  Position  Command  and  System  Response  of  PID3  Gains 


Figure  5-5.  Position  Command  and  System  Response  of  PID6  Gains 
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Time  (ms) 


Figure  5-6.  Comparison  of  the  Response  Errors 
As  expected,  the  experimental  results  are  somewhat  slightly  different  from  the 
simulated  results.  The  actual  system  response  shows  oscillations  and  steady-state  error 
while  the  model  does  not.  This  can  be  explained  by  the  fact  that  the  model  does  not  in¬ 
clude  the  nonlinear  terms  such  as  friction  in  the  system.  Also,  the  model  perhaps  does  not 
include  the  so-called  “unmodeled  dynamics,”  which  is  characterized  by  low-magnatude 
and  high-frequency  motion.  The  overshoot  and  subsequent  oscillations  shown  in  the  ac¬ 
tual  system  are  caused  from  the  excessive  and  retarding  torque  developed  by  the  motor  as 
the  PID  controller  tries  to  compensate  for  the  friction.  Other  factors  such  as  Coulomb 
friction,  dead  zone,  and  quantization  error  also  contribute  to  these  errors.  These  factors 
are  discussed  in  detail  later  in  the  chapter. 

Among  the  three  system  responses  shown  in  Figures  5-3,  5-4,  and  5-5,  PID1 
(Fig.  5-3)  which  consists  of  Kp  =  10,  Kj  =  28,000,  and  Kd  =  40,000  show  the  best  system 
response.  One  may  argue  that  PID3  (Fig.  5-4)  has  a  faster  settling  time  than  PID1,  but 
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notice  that  the  steady-state  error  of  PID3  does  not  go  to  zero  as  shown  in  Figure  5-6.  On 
the  other  hand,  for  PID  6  (Fig.  5-5)  which  shows  that  the  steady-state  error  eventually 
becomes  zero,  the  system  has  a  longer  settling  time  than  PID1. 

5.2  Development  of  Fuzzy  Logic  Controller 

Fuzzy  logic  was  first  introduced  by  Lofti  Azdeh  of  the  University  of  California  at 
Berkeley  in  1965.  Since  then,  fuzzy  logic  has  become  one  of  the  most  successful  control 
system  schemes.  Fuzzy  logic  provides  a  bridge  in  control  system  design  between  mathe¬ 
matical  approaches  (e.g.  linear  control  design)  and  logic-based  approaches  (e.g.  expert 
systems).  While  other  approaches  require  an  accurate  model  to  represent  the  real  system, 
fuzzy  design  can  accommodate  the  ambiguities  of  real-world  human  language  and  logic. 
It  provides  both  an  intuitive  method  for  describing  systems  in  human  terms  and  automa¬ 
tion  for  the  conversion  of  those  system  specifications  into  effective  models. 

Simplicity,  flexibility,  and  cost  effectiveness  are  among  the  other  benefits  of 
fuzzy  logic.  Fuzzy  logic  is  capable  of  handling  problems  with  imprecise  data,  and  it  can 
model  nonlinear  functions  of  arbitrary  complexity.  Not  only  do  the  rule-based  approach 
and  flexible  membership  function  scheme  make  fuzzy  systems  straightforward  to  create, 
but  they  also  simplify  the  design  of  systems  and  ensure  that  the  system  designer  can  eas¬ 
ily  update  and  maintain  the  system  over  time. 

The  fuzzy  controller  consists  of  a  set  of  user-supplied  rules  of  which  the  inputs 
and  outputs  are  both  fuzzy  values.  All  control  rules  are  used  in  parallel,  and  the  recom¬ 
mended  actions  are  combined  according  to  the  fuzzy  control  rules,  which  are  weighted  by 
the  degree  of  satisfaction  of  the  antecedent.  This  implies  that  the  fuzzy  controller  has  the 
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ability  to  control  system  in  an  uncertain  or  unknown  environment.  However,  one  of  the 
fundamental  problems  of  fuzzy  control  is  how  to  establish  the  control  rules  without  hu¬ 
man  expertise  and  knowledge  of  the  plant  [Fukumi  et.  al.,  1996]. 

A  user-supplied  rule  consists  of  IF-THEN  statements  which  provide  the  output  of 
a  system.  The  rule  mechanism  is  generally  of  the  form: 

R(,)\  IF  x i  is  F/  and  is  Fj  and  ...  and  x„  is  Fj,  THEN  y1  =  c1 


R®:  IF  x/  is  Fjk  and  X2  is  Fk  and  ...  and  x„  is  F„k,  THEN  yk  =  ck 


R(m):  IF  x/  is  FT  and  xj  is  F™  and  ...  and  x„  is  Fk,  THEN  ym  =  cm 
where  R®  means  the  iih  rule 

x,  is  a  real-valued  input  variable 

Fk  is  a  fuzzy  set  specified  by  membership  functions 

Hj(Xj)  is  a  membership  function  (often  defined  as  triangular  functions) 

n  specifies  the  number  of  input  variables 

ck  is  a  real-valued  constant 

yk  is  the  system  output  for  this  rule. 

If  there  are  m  rules  defined  in  the  rule  base,  the  system  output  is 
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m 


y  =  a 


k= 1 


(5.1) 


where  wk  represents  a  variable  weight  assigned  to  the  corresponding  constant  c 
A  is  defined  as  a  scaling  and  tuning  term. 

The  individual  weights  are  computed  as 

(5-2) 

/=1  1 

To  apply  fuzzy  logic  to  a  robotics  control  system,  the  position  and  velocity  feed¬ 
back  are  used  to  compare  the  desired  values  given  by  the  operator.  The  resulting  errors 
are  then  used  to  compute  the  input  torque  of  the  actuator.  This  input  torque  can  be  con¬ 
sidered  as  the  torque  to  compensate  for  these  errors.  Therefore,  the  IF-THEN  rules  are 
written  in  the  form: 

IF  e\  is  Ej  and  ce\  is  CE\ ,  THEN  y  =  Cy  (5.3) 

where  ej  is  defined  as  position  error 
cei  is  defined  as  velocity  error 

Ej  is  the  linguistic  measure  of  the  fuzzy  sets  of  position  error 
CEi  is  the  linguistic  measure  of  the  fuzzy  sets  of  velocity  error 
Cy  is  a  constant  representing  the  torque  to  be  applied  found  on  a  look-up  table 
The  membership  functions  provide  the  continuity  of  control  inputs  rather  than  the 
on/off  Boolean  logic  strategy.  The  weights  of  Equation  (5.2)  are  now  computed  as: 
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H^=E£j(e)-Mc£j(e).qj  (5.4) 

since  n  =  2  (position  and  velocity  errors).  Substituting  these  weights  into  Equation  (5.1), 


<t  V 


u  =  A 


/=!  j=l 


q  v 


/-I  j-1  ‘ 


where  q  and  v  define  the  size  of  the  look-up  table. 


(5.5) 


5.2.1  Fuzzy  Logic  Controller  Simulation 

The  fuzzy  logic  control  scheme  developed  for  the  1  -DOF  FRMC  prototype  uses 
the  triangular  membership  functions  as  shown  in  Figure  5-7  (Position  error)  and  Figure  5- 
8  (V elocity  error). 
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These  membership  functions  represent  a  total  of  eighty-one  rules  (nine  linguistic 
measures  for  position  error  and  nine  linguistic  measures  for  velocity  error)  with  the  cen¬ 
ters  of  the  fuzzy  sets  shown  in  Table  5-2.  Although  different  spacing  between  the  centers 
can  be  done,  the  centers  of  the  fuzzy  sets  in  this  experiment  are  equally  spaced  so  that 
they  can  be  changed  easily  without  complicating  the  program.  Note  that  it  is  important 
that  a  fuzzy  set  center  be  located  at  ne  —  0  so  that  the  errors  may  converge  to  zero.  Oth¬ 
erwise,  continuous  oscillations  of  the  joint  errors  will  result  at  about  zero  or  at  conver¬ 
gence  to  a  nonzero  value  at  which  the  system  provides  no  error  compensation  [Monte- 
verde,  1997],  Crossover  of  the  non-zero  membership  functions  is  limited  to  one  crossover 
for  any  point  along  the  error  and  velocity  error  axes  although  different  schemes  can  be 
used  that  may  be  more  effective. 


Table  5-2.  Centers  for  the  Position  Error  and  Velocity  Error  for  the  Membership 
Functions  from  Figures  5-7  and  5-8 


Position  error  center 

Value  (radians) 

Velocity  error  center 

Value  (rps) 

nel 

-0.25 

ncel 

-1.5 

ne2 

-0.1875 

nce2 

-1.125 

ne3 

-0.125 

nce3 

-0.75 

ne4 

-0.0625 

nce4 

-0.375 

ne5 

0.0 

nce5 

0.0 

ne6 

0.0625 

nce6 

0.375 

ne7 

0.125 

nce7 

0.75 

ne8 

0.1875 

nce8 

1.125 

ne9 

0.25 

nce9 

1.5 
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The  membership  functions  vary  from  0  to  1  and  can  be  calculated  from  Figures  5- 
7  and  5-8  with  knowledge  of  the  position  error  and  velocity  error.  The  control  input 
(Equation  5.5)  can  then  be  determined  utilizing  the  membership  functions  and  the  look¬ 
up  table  of  constant  input  values  (Table  5-3)  with  q  =  9  and  v  =  9.  The  model  obtained  in 
the  previous  section  is  used  to  simulate  the  1-DOF  FRMC  prototype.  Moreover,  the  con¬ 
stant  values  in  Table  5-3  represent  the  values  of  input  voltage  that  can  be  provided  by  the 
actual  actuator  of  the  1-DOF  FRMC.  A  look-up  table  has  to  be  generated  that,  in  essence, 
is  a  set  of  gains  for  the  system.  According  to  Cha  [Cha  et.  el.,  1996],  the  performance  of  a 
teleoperation  system  is  greatly  influenced  by  the  force-reflection  gain.  If  the  gain  is  too 
small,  the  performance  is  poor.  If  the  gain  is  too  large,  the  system  is  unstable.  To  simplify 
this  process,  the  look-up  table  is  set  up  as  a  function  of  a  single  base  value.  The  base 
value  is  multiplied  by  the  weighting  corresponding  to  the  position  in  the  table. 

In  the  simulations  and  actual  experiments  of  the  1-DOF  FRMC  system,  the  gain 
matrix  for  scaling  and  tuning  is  set  to  1. 
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Table  5-3.  Look-Up  Table  Representing  Input  Voltage  of  the  Actuator 


The  look-up  table  coefficients  as  illustrated  in  Table  5-3  are  chosen  with  the  aim 
of  sending  the  position  and  velocity  errors  to  their  respective  zero  value  as  shown  in  Fig¬ 
ures  5-7  and  5-8  [Erbatur  et.  al.,  1995].  The  location  where  both  the  position  and  velocity 
have  a  large  negative  error  receives  a  large  negative  torque  and  vice-versa  for  the  positive 
end.  For  the  case  where  there  is  large  positive  position  error  and  large  negative  velocity 
error,  the  corresponding  table  location  receives  a  small  input  torque  due  to  the  correctness 
of  the  situation  being  somewhere  in  between  the  two  error  values.  The  same  applies  for 
the  case  of  large  positive  velocity  error  and  large  negative  position  error.  The  values  in 
between  these  cases  are  chosen  in  the  same  manner  so  as  to  produce  a  continuous  table 
flow  towards  zero. 

Figure  5-9  depicts  one  of  the  simulated  results  using  a  fuzzy  logic  controller 
where  the  base  value  is  0.5.  Again,  the  parabolic  function  input  is  used  here  as  the  desired 
path  for  the  reason  stated  earlier. 


Figure  5-9.  Simulated  System  Response  under  Fuzzy  Logic  Controller 
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Observed  from  the  above  figure  that  the  model  under  fuzzy  logic  controller  fol¬ 
lows  the  desired  path  exactly.  However,  this  may  not  be  the  case  for  the  actual  system  as 
demonstrated  in  the  next  section. 

5.2.2  Experiments  on  the  1-DOF  FRMC  by  Implementing  the  Fuzzy  Logic 
Controller 

The  fuzzy  logic  control  method  developed  in  the  previous  section  is  implemented 
on  the  1-DOF  FRMC  prototype.  All  of  the  parameters  used  in  the  simulation  are  applied 
to  the  actual  system.  One  of  the  main  objectives  of  the  experiments  is  to  compare  the 
numerical  results  obtained  from  the  mathematical  model  and  that  of  laboratory  data.  In 
doing  so,  the  0.5  base  value  is  used  in  the  experiments.  Figure  5-10  shows  the  response 
obtained  from  the  actual  system  with  b  =  0.5. 


Figure  5-10.  Actual  System  Response  under  Fuzzy  Logic  Controller  of  Base  Value  of  0.5 
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When  the  experimental  data  (Figure  5-10)  are  compared  with  the  simulation  re¬ 
sults  obtained  from  mathematical  model  (Figure  5-9),  it  is  observed  that  they  match  quite 
well  with  the  exception  of  a  slight  overshoot  in  the  transient  behavior  and  minimal 
steady-state  error.  This  is  because,  as  explained  earlier,  in  a  real  system  there  are  friction 
and  otljer  nonlinear  system  characteristics,  such  as  dead  zone  and  quantization  errors 
which  are  not  considered  in  the  simulation.  These  errors  in  a  control  system  are  almost 
unavoidable.  The  next  section  discusses  these  errors  in  detail. 

Figures  5-11  and  5-12  show  the  actual  system  response  of  the  1-DOF  FRMC  test¬ 
bed  under  fuzzy  logic  controller  with  various  base  values. 


Figure  5-11.  Actual  System  Response  with  Base  Values  between  0.35  to  0.5 
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Figure  5-12.  Actual  System  Response  with  Base  Values  between  0.5  to  0.6 


As  can  be  seen  from  the  above  figures,  different  base  values  produce  different 
system  response.  Thus,  the  fuzzy  logic  controller,  as  is  the  case  with  most  controllers,  the 
selection  of  the  system  gain  is  one  of  the  most  important  factors  that  determine  the  per¬ 
formance  of  the  system.  In  the  case  of  the  1  -DOF  FRMC,  the  most  appropriate  base  value 
is  0.5  for  the  look-up  table  represented  in  Table  5-3.  Note  that  the  results  obtained  above 
were  in  the  case  that  the  operator  held  the  joystick  with  a  loose  grip. 

A  soft  grip  uses  lower  gains  while  a  firm  grip  uses  higher  gains  in  order  to  pro¬ 
vide  a  force-reflection  sensation.  As  for  the  1  -DOF  FRMC,  the  experiments  show  that  for 
the  stable  region  of  the  soft  grip,  the  base  value  is  in  the  range  of  0.35-0.55;  whereas  for 
the  firm  grasp,  the  base  value  can  be  as  much  as  0. 8-1.0.  If  the  base  value  falls  below  the 
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above  values,  poor  performance  results,  and  higher  base  value  causes  the  system  to  be 
unstable. 

5.3  A  Comparison  of  the  System  Performance  of  PID  Controller  and  Fuzzy  Logic 
Controller 

A  comparison  of  the  system  response  between  PID  controller  and  fuzzy  logic 
controller  is  shown  in  Figure  5-13.  All  of  the  system  parameters  used  in  this  experiment 
are  the  same  as  before  where  the  gains  for  PID  controller  are  set  as  Kp  =  10,  Ki  =  28,000, 
and  Kd  =  40,000,  and  the  base  value  (b)  for  fuzzy  logic  controller  is  selected  as  0.5. 


Figure  5-13.  A  Comparison  of  System  Response  between  PID  and 
Fuzzy  Logic  Controllers 
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As  can  be  seen  in  the  Figure  5-13,  both  controllers  follow  the  desired  path  quite 
well.  The  differences  are  that  PID  shows  an  overshoot  and  transient  oscillations  but  has 
no  steady-state  error,  whereas  the  fuzzy  logic  controller  produces  no  oscillations,  but  it 
displays  steady-state  error  and  can  not  catch  up  with  the  desired  path  at  the  beginning  as 
well  as  PID.  Therefore,  the  choice  of  selecting  a  controller  between  the  PID  and  fuzzy 
logic  approaches  will  depend  largely  on  the  operator  and  the  requirements  of  the  tasks 
since  each  has  its  benefits  and  drawbacks.  However,  for  the  purpose  of  force-reflecting 
manual  controller  application,  where  a  very  high  precision  is  not  required  due  to  the 
limitations  on  human  perception,  the  performance  of  both  controllers  are  judged  to  be 
acceptable. 

5.4  Errors  Caused  by  Nonlinear  System  Elements 

According  to  Figure  5-6  (PID  system  response  errors)  and  Figure  5-10  (Fuzzy 
logic  system  response),  errors  of  control  systems  are  attributed  to  static  and  dynamic 
friction  and  some  nonlinear  system  characteristics.  Static  friction  or  stiction  represents  a 
retarding  force  that  tends  to  prevent  motion  from  beginning.  The  static  friction  force  can 
be  represented  by  the  expression 

f(t)=±(F,)M  (5.6) 

In  Equation  (5.6),  f(t)  is  defined  as  a  frictional  force  that  exists  only  when  the  body  is 
stationary  but  has  a  tendency  of  moving.  The  sign  of  the  friction  depends  on  the  direction 
of  motion  or  the  initial  direction  of  velocity. 
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The  force-to- velocity  relation  of  static  friction  is  illustrated  in  Figure  5-14.  Notice 
that  once  the  motion  begins,  the  static  friction  vanishes  and  dynamic  or  viscous  friction 
takes  over.  For  the  1-DOF  FRMC,  the  static  friction  torque  is  measured  to  be  around  0.27 
lb-in. 


f 


Figure  5-14.  Force-to-Velocity  Relation  of  Static  Friction 

The  errors  at  the  transient  portion  and  at  the  steady  state  are  usually  caused  by 
nonlinear  system  elements.  According  to  Kuo  [Kuo,  1991],  steady-state  errors  of  control 
systems  are  attributed  to  some  nonlinear  system  characteristics  such  as  nonlinear  friction 
or  dead  zone.  The  amplifier  used  in  the  control  system  often  has  the  input-output  charac¬ 
teristics  shown  in  Figure  5-15.  When  the  amplitude  of  the  amplifier  input  signal  falls 
within  the  dead  zone,  the  output  of  the  amplifier  will  be  zero,  and  the  control  will  not  be 
able  to  correct  the  error  if  any  exists.  Dead-zone  nonlinearity  characteristics  shown  in 
Figure  5-15  are  not  limited  to  amplifiers.  The  flux-to-current  relation  of  the  magnetic 
field  of  an  electric  motor  often  exhibits  a  similar  characteristic.  Thus,  as  the  current  of  the 
motor  falls  below  the  dead  zone  D,  no  magnetic  flux,  and;  thus,  no  torque  will  be  pro- 
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duced  by  the  motor.  On  the  other  hand,  when  the  input-signal  magnitude  exceeds  a  cer¬ 
tain  level,  the  amplifier  may  be  subject  to  saturation  characteristics  as  in  Figure  5-15. 
Similarly,  when  the  magnetic  field  of  the  motor  is  saturated,  increasing  the  armature  cur¬ 
rent  will  no  longer  produce  additional  torque. 

Output 


Figure  5-15.  Typical  Input-Output  Characteristics  of  an  Amplifier  with 
Dead  Zone  and  Saturation 


The  output  signals  of  digital  components  used  in  control  systems,  such  as  a  mi¬ 
croprocessors,  can  take  on  only  discrete  or  quantized  levels.  This  property  is  illustrated 
by  the  quantization  characteristics  shown  in  Figure  5-16.  When  the  input  to  the  quantizer 
is  within  +/-  0.5q,  the  output  is  zero,  and  the  system  may  generate  an  error  in  the  output 
whose  magnitude  is  related  to  +/-  0.5q. 
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Output 


Figure  5-16.  Typical  Input-Output  Characteristics  of  a  Quantizer 


The  Coulomb  friction  is  also  a  common  cause  of  steady-state  position  errors  in 
control  systems.  Coulumb  friction  is  a  retarding  force  that  has  a  constant  amplitude  with 
respect  to  the  change  in  velocity,  but  the  sign  of  the  frictional  force  changes  with  the  re¬ 
versal  of  the  direction  of  velocity.  The  mathematical  relation  for  the  Coulomb  friction  is 
given  by 


fif)=Fc 


X01 

■  dt  \ 


dt 


(5.7) 


Figure  5-17  shows  a  restoring-torque-versus-position  curve  of  a  control  system. 
The  torque  curve  typically  can  be  generated  by  a  step  motor  or  a  switched-reluctance 
motor,  or  from  a  closed-loop  system  with  a  position  encoder.  The  point  0  designates  a 
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stable  equilibrium  point  on  the  torque  curve,  as  well  as  the  other  periodic  points  along  the 
axis  where  the  slope  on  the  torque  curve  is  negative.  The  torque  on  either  side  of  the 
point  0  represents  a  restoring  torque  that  tends  to  return  the  output  to  the  equilibrium 
point  when  some  angular-displacement  disturbance  takes  place.  When  there  is  no  friction, 
the  position  error  should  be  zero,  since  there  is  always  a  restoring  torque  so  long  as  the 
position  is  not  at  the  stable  equilibrium  point.  If  the  rotor  of  the  motor  sees  a  Coulomb 
friction  torque  Tf,  then  the  motor  torque  must  first  overcome  this  frictional  torque  before 
producing  any  motion.  Thus,  as  the  motor  torque  falls  below  Tp  as  the  rotor  position  ap¬ 
proaches  the  stable  equilibrium  point,  it  may  stop  at  any  position  inside  the  shaded  band 
shown  in  Figure  5-17,  and  the  error  band  is  bounded  by  +/-0e. 


Figure  5-17.  Torque-Angle  Curve  of  a  Motor  or  Closed-Loop  System  with  Coulomb 

Friction  (Adapted  from  Kuo,  1994) 
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CHAPTER  6 

DEVELOPMENT  OF  A  TELESENSATION  SYSTEM 

In  this  chapter,  the  ongoing  development  of  a  telesensation  system  which  is  being  devel¬ 
oped  at  the  Robotics  and  Automation  Laboratory  at  Florida  International  University  in 
Miami  is  presented.  Such  a  system  consists  of  three  distinct  components:  Virtual  Reality 
(VR)  unit,  Force-Reflecting  Manual  Controller  (FRMC),  and  Graphical  User  Interface 
(GUI).  An  overview  of  VR  units  is  given.  Furthermore,  an  extensive  survey  of  commer¬ 
cial  VR  units  has  been  conducted  in  order  to  identify  the  most  appropriate  unit  for  the 
telesensation  system.  Later,  the  design  of  the  3 -DOF  FRMC  is  presented.  This  includes  a 
review  of  the  actuator  system  design  alternatives  and  a  survey  of  the  actuator  system 
available  commercially.  In  addition,  various  design  alternatives  for  the  3-DOF  FRMC  are 
presented.  The  relative  merits  of  different  options  are  also  discussed.  Finally,  the  devel¬ 
opment  of  the  GUI  software  is  presented. 

6.1  Virtual  Reality  Unit 

A  Virtual  Reality  (VR)  unit  is  a  visual  device,  similar  to  a  helmet,  that  enables  a 
person  to  perceive  and  interact  with  a  virtual  environment  as  if  it  were  real  [Miner  and 
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Stansfield,  1994].  In  telesensation  systems,  the  VR  unit  provides  the  view  of  the  remote 
site  as  the  operator  turns  or  tilts  his/her  head  which  corresponds  to  a  remote  system  cam¬ 
era.  A  VR  system  not  only  provides  the  operator  with  the  3-D  view  of  the  remote  site,  but 
also  sound  feedback,  voice  input  and  motion  tracking  [Christopher  and  Stansfield,  1994], 
A  standard  TV  monitor  is  not  able  to  provide  the  operator  with  a  sense  of  a  3-D  view  of 
the  working  environment.  Thus,  the  feeling  of  presence  and  sensation  is  reduced  which 
results  in  poor  performance  [Trivedi  and  Chen,  1993]. 

One  of  the  major  advantages  of  having  a  VR  unit  is  that  the  actual  manipulator 
can  be  removed  from  the  training  loop  while  the  operator  is  being  trained.  This  training 
approach  can  be  quite  beneficial  because  the  robot  cannot  be  damaged  by  any  mistreat¬ 
ment  by  an  operator,  and  the  operator  should  feel  more  comfortable  during  the  training 
exercise.  In  addition,  training  scenarios  can  be  set  up  easily.  These  scenarios  usually  in¬ 
clude  an  emergency  situation  procedure  training.  Should  the  actual  emergency  occur,  the 
operator  would  be  much  better  in  handling  the  situation  [Miner  and  Stansfield,  1994], 
Also,  the  cost  associated  with  training  personnel  reduces  significantly  since  direct  hard¬ 
ware  usage  is  significantly  reduced. 

The  Current  State-of-the-Art  VR  Systems 

Vision 

VR  systems  usually  include  stereo  vision.  Two  types  of  displays  used  in  lower 
cost  systems  are  Liquid  Crystal  Displays  (LCD)  and  CRT.  The  CRT  display  areas  are 
usually  small  with  high  light  output  while  flat-panel  LCD  displays  have  low  weight  and 
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optional  color,  but  with  poor  resolution  and  relatively  low  light  output.  Thus,  CRTs  are 
more  preferable  in  display  design  with  folded  optical  paths. 

In  terms  of  complexity  and  realism,  VR  units  have  similar  objectives  of  visual 
image  generation  to  those  in  aircraft  simulation.  However,  faster  scene  changes  are  re¬ 
quired  in  the  VR  systems  as  a  result  of  user  head  movements.  VR  units  must  be  able  to 
provide  effective  visual  simulation  which  requires  computational  complexity  in  order  to 
eliminate  hidden  lines  and  produce  effective  perspective  [Burdea,  1994].  In  addition, 
computational  speed  must  be  fast  enough  to  provide  the  operator  with  acceptable  scene 
update  rates.  Currently,  one  of  the  most  powerful  and  popular  work  stations  is  produced 
by  Silicon  Graphics. 

The  image  generator  produces  an  output  by  receiving  the  signal  from  the  meas¬ 
urement  of  head  movements  which  are  measured  optically,  acoustically,  mechanically  or 
magnetically.  One  of  the  most  popular  systems  is  the  Polhemus  Spasyn  system.  This 
technique  requires  only  small  sensors  to  be  mounted  on  the  head  and  is  insensitive  to 
most  interference.  However,  one  of  the  biggest  disadvantages  of  this  system  is  that  the 
accuracy  is  affected  by  metal,  and  the  environments  must  be  mapped  extensively. 

Audio 

An  audio  system  is  one  of  the  most  important  elements  in  VR  units.  Spatially  dis¬ 
tinct  sounds  are  important  attributes  of  a  convincing  virtual  reality.  One  approach  to  pro¬ 
duce  a  successful  virtual  3-D  sound  is  to  apply  a  mathematical  function  called  Head- 
Related  Transfer  Function  or  HRTF.  The  HRTF  relates  to  an  individual’s  ear  shape,  but 
generalized  HRTFs  have  been  successfully  created  that  work  for  most  people.  Research 
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has  shown  that  perceptual  errors  can  cause  problems,  such  as  sounds  behind  the  head  that 
are  perceived  as  if  they  were  in  the  front  of  the  head.  These  types  of  problems  cannot  be 
solved  even  when  generalized  HRTFs  are  used  [Vince,  1995], 

One  of  the  most  efficient  VR  systems,  built  at  the  Armstrong  Aerospace  Medical 
Research  Laboratory,  is  called  the  Visually  Coupled  Airborne  Systems  Simulator 
(VCASS).  The  system  uses  miniature  CRTs  as  image  resources  to  produce  high- 
resolution  displays.  VCASS  provides  a  binocular  field  of  view  of  120  degrees  horizontal 
and  60  degrees  vertical.  It  has  high  bandwidth  video  amplifiers,  programmable  analog 
circuits  for  pre-distorting  the  images  and  many  other  features.  Other  proficient  VR  units 
have  been  produced  by  Honeywell  for  use  in  the  “Falcon  Eye,”  the  F-16  night  attack 
system,  the  Apache  attack  helicopter  and  in  other  various  British  research  projects. 

Extensive  teleoperation  research  projects  using  the  VR  technology  have  been  de¬ 
veloped  at  NASA’s  AMES  Research  Project  [Stark  et.  al.,  1987];  the  JPL  to  control  re¬ 
motely  deployed  robots  [Bejczy,  1980];  the  Automation  and  Robotics  (A&R)  Division  at 
the  Johnson  Space  Center  (JSC)  for  telepresence  research,  robotics  and  extravehicular 
activities  (EVA)  analysis  and  training  [Read  et.  al.,  1994];  the  Advanced  Controls  Ma¬ 
nipulation  Laboratory  (ACML)  at  Sandia  National  Laboratories  for  waste  remediation 
technologies;  the  University  of  Tennessee  at  Knoxville  Mobile-Manipulator  Robotics  Re¬ 
search  (M2R2);  and  the  Oak  Ridge  National  Laboratory  (ORNL)  Advanced  Servo  Ma¬ 
nipulator  (ASM)-based  Decontamination  and  Decommissioning  (D&D)  [Trivedi  and 
Chen,  1993]. 
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Some  of  the  commercial  VR  units  available  on  the  market  are  briefly  reviewed 
below.  These  include  the  Visual  Immersion  Module,  VIM,  Liquid  Image  MRG2.2,  Vir¬ 
tual  Research  System  VR4  and  Personal  Use  Stereoscopic  Haptic,  PUSH,  virtual  reality 
systems. 

Visual  Immersion  Module  (VIM) 

The  Visual  Immersion  Module  (VIM),  as  shown  in  Figure  6-1,  is  produced  by 
Kaiser  Electro-Optics,  Inc.  There  are  two  models  available:  500HRpv  and  lOOOHRpv. 
The  500HRpv  employs  two  full-color,  0.7”  Active  Matrix  LCD  (AMLCD)  displays  with 
a  resolution  of  180,000  pixels  per  LCD.  The  field  of  view  (FOV)  is  approximately  50° 
and  weighs  only  26  oz.  The  lOOOHRpv  provides  four  full-color  displays  instead  of  two 
and  has  a  vertical  FOV  of  30°  and  100°  horizontally.  Both  provide  built-in  Sennheiser  2- 
channel  stereo  headphones  [Batsomboon  et.  al.,  1996c], 


Figure  6-1 .  Visual  Immersion  Module  (VIM) 


Liquid  Image  MRG2.2 

The  MRG2.2  (Figure  6-2)  is  one  of  the  various  VR  units  manufactured  by  the 
Liquid  Image  Corporation.  The  unit  employs  a  single,  full-color  AMLCD  display  type 
with  a  resolution  of  240  x  720  pixels  per  eye.  It  has  a  FOV  of  84°  horizontally  and  65° 
vertically.  Internally  mounted  microphones  and  positional  tracker  are  two  of  the  many 
options  that  can  be  incorporated. 


Figure  6-2.  Liquid  Image  MRG2.2 

Virtual  Research  Systems  VR4 

The  VR4  (Figure  6-3)  is  manufactured  by  Virtual  Research  Systems,  Inc.  This 
light-weight  unit  (33  oz.)  has  a  field  of  view  of  60°  diagonal  at  100%  overlap  and  67°  at 
85%  overlap.  Each  eye  has  a  resolution  of  742  x  230  pixels  which  is  equivalent  to  56,887 
triads.  The  VR4  employs  a  1.3”  diagonal  AMLCD  display  type  and  Sennheiser  HD440 
digitally  compatible  headphones  [Batsomboon  et.  al.,  1996c], 
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Figure  6-3.  Virtual  Research  Systems  VR4 

Personal  Use  Stereoscopic  Haptic  (PUSH) 

The  Personal  Use  Stereoscopic  Haptic  (PUSH),  as  shown  in  Figure  6-4,  is  a 
desktop  immersive  display  produced  by  Fakespace.  The  unit  provides  an  adjustable  field 
of  view  of  30°  to  140°  with  a  resolution  of  1280  x  1024  triads  per  eye.  It  has  6-DOF  con¬ 
trol  with  3-DOF  PUSH  interface.  A  test  has  been  conducted  by  Fakespace  to  examine  the 
unit.  Users  ranging  from  expert  to  novice  were  asked  to  navigate  through  a  virtual  test 
environment.  With  PUSH  technology,  the  company  claims  that  the  users  were  able  to 
navigate  in  a  large  virtual  space  or  zoom  in  to  see  the  objects  from  different  viewpoints. 


Figure  6-4.  Personal  Use  Stereoscopic  Haptic  (PUSH) 
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For  the  purpose  of  implementing  a  VR  unit  in  a  telesensation  system,  although 
any  of  the  systems  reviewed  above  might  be  used,  either  the  VIM  lOOOHRpv  or  VR4 
would  be  more  suitable.  Both  systems  provide  built-in  stereo  headphones  and  a  good 
range  of  field  of  view  with  fine  resolution.  Their  lightweight  and  reasonable  costs  make 
them  more  attractive. 

6.2  Design  of  a  3-DOF  Force-Reflecting  Manual  Controller 

A  force-reflecting  manual  controller  (FRMC),  or  joystick,  is  one  of  the  devices 
that  can  be  used  to  control  remote  systems  in  teleoperation.  A  joystick  is  often  a  better 
control  device  than  other  available  options  such  as  a  mouse,  switchbox,  keyboard  or 
touch-screen  input  because  the  operator  identifies  better  with  the  task  [Johnsen  and 
Corliss,  1971].  However,  to  apply  the  concept  of  telesensation  to  a  conventional  teleop¬ 
eration  system,  the  joystick  should  be  able  to  reflect  forces  experienced  at  the  remote  site. 
Force  feedback  is  one  of  the  most  significant  elements  of  feedback  information  for  a  tele¬ 
sensation  system.  It  is  fundamental  for  mechanical  support,  sense  of  balance  and  a  feel  of 
touching  real  objects.  It  conveys  information  that  is  essential  in  many  activities  such  as 
training,  design  analysis  and  hazardous-environment  task  simulations  [McNeely,  et.  al., 
1995].  The  FRMC  provides  a  virtual  force  [Repperger  et.  al.,  1995]  which  enhances  the 
realism  of  the  virtual  reality-based  telesensation  system;  thus,  the  performance  of  the  op¬ 
erator  is  greatly  improved. 

Unfortunately,  most  of  the  force-reflecting  manual  controllers  are  bulky,  complex, 
and  high  cost.  In  order  to  improve  the  design  to  meet  criteria  such  as  compactness,  port- 
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ability,  and  low  costs,  the  motors  currently  available  on  the  market  from  various  compa¬ 
nies  are  surveyed.  The  actuators  to  be  used  in  constructing  the  3 -DOF  FRMC  will  be 
based  upon  the  data  obtained.  In  addition,  a  variety  of  conceptual  designs  of  the  3-DOF 
FRMC  are  proposed. 

6.2.1  Actuator  System  Design  Alternatives 

Currently,  two  actuator  system  designs;  (i)  motor  and  speed  reducer  combination, 
and  (ii)  direct  drive,  have  been  implemented  in  the  development  of  the  force-reflecting 
manual  controller. 

Motor  and  Speed  Reducer  Combination  System 

This  traditional  system  has  been  implemented  in  the  majority,  if  not  all,  of  force- 
reflecting  manual  controllers.  The  system  consists  of  a  servomotor  and  gear  reduction  in 
order  to  satisfy  the  output  torque  requirement.  One  of  the  advantages  of  this  system  is 
that  the  motors  can  be  very  small  and  use  high  gear  ratio  sets  to  obtain  the  desired  output 
torque  [Tosunoglu  et.  al.,  1996b]. 

Table  6-1  summarizes  the  surveyed  data  of  the  brushless  DC  servomotors  which 
will  be  matched  with  the  suitable  gearhead  so  that  the  system  provides  the  desired  torque. 
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Table  6-1.  Brushless  DC  Motors  with  Frame  (see  notes  below) 


Manufac¬ 

turer 

Sipco 

Compumo- 

tor 

Sierracin/ 

Magnedyne 

Inland 

(RBEH  Series) 

Model 

17PL030 

ML  1620 

566-15 

535-01 

00510 

00412 

00511 

Peak  Torque 
(oz-in) 

8.5 

70 

38 

120 

7.04 

11.1 

15.5 

Cont.  Torque 
(oz-in) 

6.5 

15 

3.12 

4.13 

6.91 

Inertia 

(oz-in-sec2) 

.00012 

.0009 

4.5E-5 

3.6E-5 

5.0E-5 

Diameter 

(in) 

1.34 

2.25 

1.25 

2.5 

1.4 

0.96 

1.4 

Length 

(in) 

m 

5.51 

2.04 

2.2 

1.35 

1.74 

1.605 

Weight 

(lb) 

0.88 

2.9 

0.31 

2 

0.24 

0.17 

0.28 

Note  1:  Sizes  shown  indicate  motor  dimensions  only 

Note  2:  Highlighted  motor  indicates  the  most  suitable  selection  in  this  group 


Spur  and  planetary  gears  are  the  most  suitable  for  this  type  of  application.  A  high 
gear  ratio  and  nearly  zero  backlash  can  be  obtained  from  planetary  gears.  However,  be¬ 
cause  of  the  tight  mechanism,  the  contact  area  between  the  teeth  is  relatively  large,  which 
makes  them  suffer  from  high  friction.  While  spur  gears  have  relatively  lower  friction  than 
planetary  gears,  spur  gears  have  more  backlash. 

An  example  of  a  system  that  combines  a  DC  brushless  motor  and  gearhead  can  be 
obtained  from  the  SIPCO  company.  The  system  consists  of  the  motor  model  17PL030 
(the  technical  data  is  given  in  Table  6-1)  combined  with  the  compatible  planetary  gear- 
head  model  RE  34/50,  with  a  ratio  of  50:1,  a  length  of  1.61  inches  and  a  weight  of  0.46 
lb.  Thus,  the  actuator  will  provide  a  peak  torque  of  425  oz-in  and  the  system  will  have  a 
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force  reflection  of  4.43  lb.  The  overall  dimensions  of  the  actuator  are  5.31  inches  in 
length,  1.34  inches  in  diameter  and  1.34  lb.  in  total  weight. 

The  most  compact  actuator  found  is  from  the  Inland  Company.  The  system  con¬ 
sists  of  the  motor  model  RBEH  00412  (Table  6-1)  with  a  gearhead  ratio  of  45:1,  a  length 
of  1.68  inches  and  a  weight  of  0.65  lb.  Hence,  the  actuator  will  provide  the  peak  torque  of 
500  oz-in,  and  the  system  will  be  capable  of  reflecting  forces  up  to  5.20  lb.  The  overall 
size  of  the  actuator  is  3.42  inches  in  length,  0.96  inch  in  diameter  and  a  total  weight  of 
0.93  lb. 

Table  6-2  lists  some  of  the  important  properties  of  the  two  systems  described 

above. 


Table  6-2.  Motor  and  Speed  Reducer  Combination  Systems 


Manufacturer 

Sipco 

Inland 

Motor  Model 

17PL030 

RBEH  00412 

Gearhead  Ratio 

50:1 

45:1 

Peak  Torque  (oz-in) 

425 

500 

Diameter  (in) 

1.34 

"  0.96  ; 

Overall  Length  (in) 

5.31 

Overall  Weight  (lb.) 

1.34 

0.93  ; 
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One  of  the  major  drawbacks  of  this  system,  however,  is  the  friction  and  backlash 
problems  caused  by  the  gearing  system.  Other  disadvantages  include  poor  dynamic  re¬ 
sponse  and  difficulty  in  controlling  torque  and  fine  movement. 

Direct  Drive  System 

A  direct  drive  system  couples  the  system’s  load  directly  to  the  motor  without  the 
need  of  intermediate  transmission  elements  such  as  gears  or  belts.  Such  a  system  is 
brushless  and  gearless;  it  eliminates  friction  and  backlash  problems.  As  a  result,  better 
accuracy  and  smooth  rotation  can  be  obtained.  The  reliability  of  the  system  is  also  im¬ 
proved  because  a  smaller  number  of  components  is  used. 

However,  the  motors  need  to  have  an  efficient  cooling  system  since  the  motor 
must  carry  the  entire  load  directly  and  continuously;  otherwise  the  motor  may  be  over¬ 
heated  and  burned  out.  Thus,  the  actuators  must  be  carefully  selected. 

The  following  table  (Table  6-3)  presents  some  of  the  sample  surveyed  data  ob¬ 
tained  from  different  manufacturers  regarding  rare-earth  permanent  magnet  brushless  DC 
motors.  The  motors  represented  in  the  table  below  have  the  range  of  required  torque  with 
reasonable  sizes  for  the  3-DOF  FRMC  design. 
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Table  6-3.  Surveyed  Data  of  Frameless  Brushless  DC  Motors  Properties 


Manufacturer 

QMC 

Sierracin/Magnedyne 

Inland  (RBE  series) 

Model 

2183 

588-05 

w/sensor 

559-12 
w/o  sensor 

01516 

01812 

02111 

Peak  Torque 
(oz-in) 

327 

525 

300 

489 

654 

576 

Cont.  Torque 
(oz-in) 

109 

154 

*  173 

. 

224 

Inertia 

(oz-in-sec2) 

0.0055 

0.005 

0.012 

0.0114 

0.0001 

Diameter 

(in) 

2.00 

2.00 

3.35 

2.40 

na 

3.73 

Length 

(in) 

4.80 

3.70 

1.30 

2.60 

1.55 

1.40 

Weight 

(lb) 

2.40 

2.00 

1.25 

2.09 

1.70 

2.20 

Of  these  various  manufacturers,  Inland  is  judged  to  be  the  most  suitable  company 
for  the  development  of  a  1-DOF  FRMC  prototype.  It  provides  high-performance  motors 
with  relatively  smaller  sizes  than  the  other  companies.  Among  the  Inland  actuators,  three 
models  in  Table  6-3  provide  the  range  of  our  desired  torque  with  the  most  compact  sizes. 

Aside  from  the  output  torque,  the  size  of  these  motors  is  of  great  importance  in 
this  project.  The  configuration  of  model  01516  is  similar  to  those  of  conventional  motors 
where  the  length  is  longer  than  the  diameter  while  the  models  01812  and  02111  are  of  the 
pancake  type,  where  the  diameters  are  larger  than  the  lengths.  The  influence  of  these  dif¬ 
ferent  configurations  will  have  great  effects  on  the  design  of  the  3-DOF  FRMC. 
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Proposed  Actuator  System  Design  for  the  3-DOF  Force-Reflecting 
Manual  Controller 

Table  6-4  compares  some  of  the  important  characteristics  and  properties  of  the 
system  with  the  gearhead  and  the  direct  drive  system.  These  are  the  actual  numbers  ob¬ 
tained  from  the  surveyed  data. 


Table  6-4.  Comparison  of  Speed  Reducer  System  and  Direct  Drive  Properties 


Property 

Motor  with  Speed  Reducer 

Direct  Drive 

Motor  Model 

RBEH  00412 

RBE  01812 

Gearhead  Ratio 

45:1 

NONE 

Peak  Torque  (oz-in) 

500 

654 

Diameter  (in) 

0.96 

3.00 

Length  (in) 

3.42 

1.55 

Weight  (lb) 

0.93 

1.70 

As  can  be  seen  from  the  above  review  of  two  alternative  designs,  the  direct  drive 
system  can  be  as  compact  as  the  traditional  system  with  motor  and  gearhead.  Therefore, 
at  the  current  state,  the  proposed  design  of  the  3-DOF  FRMC  will  be  of  the  direct  drive 
structure  using  a  brushless  DC  motor  as  the  actuator  to  drive  the  system.  The  possible 
motor  that  will  be  used  in  our  development  is  manufactured  by  the  Inland  Company.  Fig¬ 
ure  6-5  shows  the  dimensions  of  the  selected  model. 
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Figure  6-5.  Inland  brushless  DC  Motor  model  RBE  01 812 

Such  a  system  will  most  likely  satisfy  the  criteria  of  the  design  with  advantages  as 
follows: 

•  Compact  size 

•  Light  Weight 

•  Minimal  friction 

•  Zero  backlash 

•  Precise 

•  Responsive 

•  Low  noise 

•  Reliable 

•  Infrequent  maintenance  requirements 

•  Clean  and  quiet  operation 
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6.2.2  3-DOF  FRMC  Design  Alternatives 

A  variety  of  design  alternatives  have  been  developed  for  the  3-DOF  FRMC  with 
some  promising  results.  Most  of  these  are  in  the  form  of  parallel  structure  since  it  allows 
a  movement  in  any  axis  without  causing  force  and  inertia  components  on  the  other  two 
axes.  The  serial  structure  is  also  being  considered  because  of  its  simple  configuration  and 
large  workspace. 

The  general  design  criteria  include: 

•  Compact  arrangement  for  portability  and  easy  operation 

•  Simple  mechanism  for  inexpensive  construction  and  reliable  operation 

•  Minimum  friction  and  backlash  for  precise  operation 

•  Direct  drive  configuration  for  the  elimination  of  gear  sets 

The  removal  of  gear  sets  will  cause  a  growth  in  actuator  size  due  to  the  absence  of 
speed-reducing  mechanisms  in  the  system.  However,  it  in  turn  provides  a  simpler  ar¬ 
rangement  with  a  quicker  response,  a  wider  margin  of  reliability,  and  longer  life  since 
there  are  fewer  parts  in  the  system  that  are  prone  to  loads,  fatigue  and  breakage.  The 
following  section  describes  the  four  most  promising  design  alternatives. 
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Design  Alternative  1 


Figure  6-6.  Proposed  Design  1  (Parallel  Configuration) 


In  this  design,  the  X-  and  Y-direction  actuators  are  located  in  the  same  plane,  an 
arrangement  that  reduces  the  height  of  the  controller  but  also  uses  extra  space  in  the  hori¬ 
zontal  dimensions. 

The  design  of  the  vertical  shaft  assembly  (piece  1)  provides  a  slim  connection 
with  both  horizontal  shafts  (pieces  2  and  3)  (See  Proposed  Design  1  in  Appendix  for 
definition  of  various  pieces).  This  offers  an  excellent  reduction  in  friction,  although  it 
may  be  prone  to  backlash.  The  vertical  shaft  assembly  does  not  allow  the  positioning  of 
the  Z-direction  actuator  to  be  inside  the  mechanism.  Instead,  the  Z-direction  actuator  is 
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best  placed  within  the  handle  grip  itself  for  compactness.  However,  in  order  to  be  able  to 
place  the  actuator  inside  the  handle,  the  actuator  must  be  sufficiently  small.  As  a  result, 
the  force-reflection  capability  is  reduced. 

The  shape  of  the  X-direction  shaft  (piece  2)  poses  some  challenges  and  may  cause 
extra  expenses  during  manufacturing.  The  X-direction  shaft  has  a  complex  form  with 
solid  circular  rod-shaped  ends  merged  with  a  slotted  center  for  passage  of  the  vertical 

shaft  assembly.  A  detailed  illustration  of  the  alternative  designs  is  provided  in  the  Ap¬ 
pendix. 

Design  Alternative  2 


Figure  6-7.  Proposed  Design  2  (Parallel  Configuration) 
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Figure  6-7  shows  the  second  proposed  design  for  the  3 -DOF  force-reflecting 
manual  controller.  This  design  utilizes  a  sphere  as  a  guide  to  the  movement  of  the 
mechanism. 

The  handle  shaft  (piece  1)  is  directly  connected  to  the  sphere  to  provide  the 
movement  for  the  X-  and  Y-direction  shafts  in  all  directions.  The  sphere  also  houses  the 
Z-direction  servomotor.  The  size  of  this  actuator  determines  the  minimum  dimensions  of 
the  sphere. 

The  sphere  reduces  the  number  of  different  parts  of  the  mechanism  but  increments 
its  friction  due  to  the  large  contact  area.  The  use  of  teflon  in  the  grooves  will  reduce  the 
friction.  The  multiple  tasks  of  the  sphere  dictate  an  inherently  intricate  design.  Because 
of  this,  the  manufacturing  and  assembly  of  the  sphere  will  increase  the  cost  of  the  unit. 

The  sphere  creates  other  problems  in  servicing  the  system  since  it  shields  the  third 
actuator,  and  the  whole  controller  has  to  be  completely  disassembled  to  reach  this  servo¬ 
motor.  Another  concern  is  how  the  location  of  the  wiring  connecting  this  actuator  with 
the  rest  of  the  system  will  be  achieved. 


Ill 


Design  Alternative  3 


Figure  6-8.  Proposed  Design  3  (Parallel  Configuration) 


Figure  6-8  demonstrates  the  third  proposed  design,  a  gimbal  type  assembly.  The 
arrangement  offers  one  of  the  best  alternatives  for  the  controller.  The  gimbal  arcs  occupy 
less  space  than  a  sphere  and  they  are  much  simpler  to  design  and  manufacture.  They  pro¬ 
vide  adequate  space  to  locate  the  Z-direction  servomotor  and  yet  offer  excellent  accessi¬ 
bility  without  having  to  disassemble  the  entire  system. 

The  design  of  the  universal  connection  (piece  1  in  Appendix)  is  critical  for  the 
proper  operation  of  the  entire  controller;  it  is  the  most  complex  part  of  the  design.  This 
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part  allows  the  displacement  of  the  gimbals  in  all  directions,  operating  precisely  with 
minimum  friction  and  backlash.  Both  the  handle  and  the  frame  of  the  Z-direction  actuator 
are  attached  to  it  at  each  end,  demanding  a  sturdy  construction.  The  connecting  shaft 
between  them  must  pass  through  piece  1  with  enough  play  to  provide  precise  operation 
but  also  with  enough  tightness  to  avoid  any  unnecessary  play.  All  these  conditions  need 
to  be  considered  carefully  in  the  structural  design  of  the  controller. 

Design  Alternative  4 


Figure  6-9.  Proposed  Design  4  (Serial  Configuration) 
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Figure  6-9  depicts  the  design  alternative  in  serial  structure.  This  design  provides 
the  largest  workspace  among  the  above  designs.  This  simple  configuration  makes  it  easy 
to  manufacture,  assemble  and  dissemble. 

However,  this  serial  structure  has  a  major  advantage  inherent  to  serial  systems. 
The  actuator  that  rotates  about  the  X  axis  must  carry  the  weight  of  the  two  actuators  that 
rotate  about  the  Y  and  Z  axes,  and  likewise,  the  actuator  that  rotates  about  the  Y  axis 
must  carry  the  weight  of  the  actuator  that  rotates  in  the  Z  direction.  As  a  result,  the  ac¬ 
tuators  will  have  to  be  selected  such  that  they  are  capable  of  carrying  the  load  of  the  other 
and  at  the  same  time  to  provide  the  required  force  reflection.  This,  in  turn,  influences  the 
size  of  the  actuator  and  the  oversize  of  the  entire  system. 

With  the  above  consideration,  the  serial  configuration  may  not  be  as  compact  as 
expected.  In  addition,  the  stiffness  and  precision  of  the  system  become  questionable  be¬ 
cause  of  this  arrangement. 

Comparison  of  Design  Alternatives 

Table  6-5  provides  a  comparative  summary  of  the  principal  design  parameters 
considered  and  how  each  alternative  meets  these  parameters. 
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Table  6-5.  Comparison  of  Design  Parameters  among  Design  Alternatives 


Alternative 

1 

Alternative 

2 

Alternative 

3 

Alternative 

4 

Direct  drive 

Yes 

Yes 

Yes 

Yes 

Simplicity  of  mechanism 

Fair 

Good 

Good 

Better 

Compactness  of  design 

Good 

Better 

Better 

Fair 

Access  to  components 

Good 

Fair 

Good 

Good 

Number  of  different  parts 

Fair 

Better 

Good 

Better 

Friction 

Low 

High 

Medium 

High 

Ease  of  assembly 

Good 

Fair 

Better 

Better 

The  four  design  alternatives  offer  room  for  improvement,  especially  in  the  loca¬ 
tion  of  the  actuators  and  general  dimensions,  which  are  largely  determined  by  the  com¬ 
mercially  available  motors.  Alternatives  2  and  3  offer  greater  flexibility  in  the  servomotor 
location,  which  is  impaired  by  alternative  1  where  the  location  of  actuators  cannot  be 
easily  changed. 

Alternative  3  offers  a  better  arrangement  for  actuator  location  than  alternative  2, 
and  the  latter  offers  an  advantage  by  using  simpler  parts.  Despite  the  advantages  of  the 
parallel  structure,  alternative  4  with  a  serial  structure  can  be  an  attractive  design  alterna¬ 
tive  because  of  its  simple  arrangement. 
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6.3  Development  of  Graphical  User  Interface  (GUI) 

Computer-based  simulations  and  training  are  very  important  tools  in  critical  op¬ 
erations  where  the  task  needs  to  be  operated  without  an  error.  Otherwise,  the  operator 
does  not  have  the  opportunity  to  practice  and  gain  expertise  in  the  operation.  Creating  a 
realistic  simulation  assists  the  operator  to  learn  the  process  before  the  actual  operation 
occurs.  Thus,  the  performance  of  the  operator  is  greatly  improved  when  operating  on  the 
actual  task.  For  advanced  operations  such  as  hazardous  material  handling  in  nuclear  re¬ 
actors  and  space  missions,  real-time  graphical  simulation  is  considered  to  be  one  of  the 
most  important  tools  for  an  advanced  teleoperator  system  [De  Rossi  et.  al.,  1997]. 

The  goal  of  the  development  of  an  advanced  graphical  user  interface  software  for 
a  teleoperation  system  is  to  provide  the  operator  with  various  options  of  operating  modes 
such  that  the  tasks  can  be  achieved  with  relative  ease  and  fidelity.  However,  the  package 
should  be  easy  to  use  and  relatively  simple  to  implement  for  any  remote  system. 

The  software  package  demonstrates  that  it  is  capable  of  accepting  multiple  inputs 
from  different  devices.  In  this  case,  it  provides  connections  to  video  cameras,  CCD  cam¬ 
eras,  force-reflecting  manual  controller,  and  virtual  reality  unit.  Unlike  many  other  soft¬ 
ware  packages  developed  on  mainframe  workstations,  our  GUI  software  operates  on  a 
standard  PC  computer.  This  allows  us  to  reduce  the  costs  and  simplify  the  entire  process 
considerably. 

The  graphical  user  interface  is  being  developed  in  a  C++  environment.  Several 
versions  of  the  interface  software  have  been  developed.  One  of  the  earlier  versions, 
shown  in  Figure  6-10,  was  developed  in  the  Windows  environment.  This  version  seemed 
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to  be  more  user-friendly  since  it  facilitated  the  manipulation  of  different  windows.  How¬ 
ever,  programming  in  a  Windows  platform  requires  much  more  space  and  memory  than 
on  a  DOS  platform  [Ezzell,  1990]. 


Teleaperatian 


Position  Scaling:  Force  Scaling;  *10  DOF:  *|  Control  POSITI  ON  ON  LaoP:  CLOSED 


Figure  6-10.  Windows-Based  Version  of  the  Interface  Software 


Figure  6-11  shows  the  most  recent  of  the  interface  software,  which  is  being  devel¬ 
oped  on  a  DOS  platform.  The  software  is  written  using  the  concept  of  objected-oriented 
programming:  the  same  concept  applied  to  the  Windows  environment  [Ezzell,  1990].  One 
of  the  advantages  of  working  on  the  DOS  platform  is  that  the  program  is  developed  in 
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terms  of  modularity.  This  allows  the  system  designer  to  easily  add  or  remove  any  features 
from  the  package.  Thus,  the  software  can  be  used  for  any  remote  system. 


Figure  6-11.  DOS-Based  Version  of  the  Interface  Software 


As  illustrated  in  Figure  6-1 1,  the  system  parameters  for  the  telesensation  system 
include  position  scaling,  force  scaling,  force/torque  sensor  sensitivity,  and  robot  work¬ 
space.  Other  features  include  rereferencing,  control  mode  (position  or  velocity),  control 
scheme  (open  or  closed  loop),  and  Degree  of  Freedom  (DOF)  setting  (joint  mode,  Carte¬ 
sian  mode,  orientation  mode).  In  addition,  a  number  of  different  windows  (video,  simula¬ 
tion,  VR)  of  graphical  presentation  can  be  viewed  simultaneously  to  enhance  the  percep- 
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tion  of  the  operator.  At  the  bottom  of  the  screen,  the  status  bar  provides  the  information 
of  all  the  system  parameters  and  other  settings.  In  the  event  that  the  program  detects  a 
problem,  it  alerts  the  operator  with  a  message  status  bar. 

The  flowchart  diagram  of  a  recent  version  of  the  interface  software  is  shown  in 
Figure  6-12.  The  software  continuously  receives  signals  from  different  devices,  interprets 
the  data,  and  processes  the  data  depending  on  the  source  of  the  signals.  The  input  data  is 
received  from  various  sources: 

•  Mouse  and  keyboard:  The  mouse  and  keyboard  provide  system  parameters  set 
by  the  user. 

•  Encoder:  The  encoder  provides  the  manual  controller  position  as  the  user 
controls  the  robot  with  the  force-reflecting  manual  controller. 

•  Force/Torque  (FT)  sensor:  The  force  feedback  is  provided  by  the  FT  sensor  in 
the  event  that  the  robot  experiences  external  forces. 

•  Head  Mounted  Display  (HMD):  The  HMD  tracks  the  movement  of  the  user’s 
head  and  provides  3-D  visual  effects. 
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Figure  6-12.  Flowchart  of  the  Interface  Software 


The  system  parameters  can  be  changed  at  any  instant  even  during  the  operation 
since  the  program  routinely  updates  the  variables.  After  the  changes  are  made,  the  pro¬ 
gram  stores  and  saves  the  new  variables  within  its  own  database.  This  software  is  written 
in  the  simplest  manner  so  that  real-time  operation  is  achieved. 
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Chapter  7 


Conclusions,  Recommendations,  and  Future  Work 

A  teleoperator  system  extends  the  intelligence  and  capabilities  of  humans  and  robots  by 
feeding  back  visual  and  force  information,  whereas  a  telesensation  system  attempts  to 
achieve  the  same  goal  by  providing  multi-sensory  feedback  to  the  operator  in  a  virtual 
reality  environment.  In  either  case,  force  reflection  represents  an  important  component  of 
these  systems.  This  component  also  makes  the  mechanical  design  of  the  overall  system 
quite  challenging  since  most  of  the  force-reflecting  manual  controllers  are  bulky,  com¬ 
plex,  and  expensive. 

7.1  Conclusions 

In  an  effort  to  develop  the  system  that  meets  the  criteria  such  as  simplicity,  port¬ 
ability,  low  cost,  ease  of  use  and  ease  of  manufacture,  chapter  2  reviews  some  of  the  pre¬ 
vious  designs  of  the  force-reflecting  manual  controller.  This  includes  mechanical  design 
and  control  strategies.  The  serial  and  parallel  architectures  are  compared,  and  the  con¬ 
ventional  and  emerging  control  strategies  are  addressed. 
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In  chapter  3,  the  fundamental  components  of  force-reflecting  teleoperation  sys¬ 
tems  are  reviewed.  These  are  actuators,  transmission  systems,  sensors,  computer  hard¬ 
ware,  computer  interface,  and  computer  software. 

In  chapter  4,  a  1-DOF  FRMC  prototype  is  designed  and  developed  to  demonstrate 
the  principle  of  the  force-reflecting  manual  controller.  The  specifications  of  the  system 
components  are  outlined.  These  include  a  brushless  DC  motor,  encoder,  amplifier,  inter¬ 
face  board,  force/torque  sensor,  and  PUMA  760  industrial  robot.  The  system  parameters 
are  then  identified  for  the  purpose  of  constructing  a  mathematical  model.  The  least 
squares  method  is  used  to  obtain  the  model  in  the  form  of  an  ARX  model.  A  variety  of 
different  order  systems  are  obtained  to  compare  the  system  response  with  the  actual  re¬ 
sponse.  The  results  show  that  the  2nd-  and  3rd-order  system  models  are  capable  of  pro¬ 
ducing  the  output  fairly  well.  However,  for  simplicity,  the  2nd-order  model  is  selected  to 
represent  the  1-DOF  FRMC  prototype  system  dynamics. 

The  model  validation  is  performed  by  creating  the  block  diagram  of  the  servo 
loop  U500  controller  and  simulating  its  performance  numerically.  The  results  are  com¬ 
pared  with  the  actual  system  response  for  different  sets  of  gains.  Although  the  model 
yields  the  output  slightly  different  from  the  actual  response,  it  displays  a  very  similar  be¬ 
havior  of  the  actual  response.  Considering  this  criterion,  the  model  is  judged  to  be  valid. 

In  chapter  5,  two  control  methods,  PID  and  fuzzy  logic  controllers,  are  numeri¬ 
cally  simulated,  using  the  model  obtained  from  the  previous  chapter,  and  experimentally 
tested  on  the  1-DOF  FRMC  prototype.  A  comparison  of  the  system  response  between  the 
output  produced  by  the  model  and  the  actual  system  for  both  types  of  controllers  is  con¬ 
ducted.  The  results  show  that  the  actual  system  displays  oscillations  and  steady-state  er- 
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ror  while  the  model  does  not.  This  is  true  for  both  PID  and  fuzzy  logic  controllers.  It  is 
concluded  that  these  errors  are  caused  by  nonlinearities  and  high-frequency  dynamics 
terms  that  are  not  included  in  the  model.  Unmodeled  dynamics  are  characterized  by  low- 
magnitude  and  high-frequency  motion,  and  nonlinear  terms  include  Coulomb  friction, 
dead  zone  and  quantization  errors. 

Furthermore,  the  range  of  the  system  gains  for  the  fuzzy  logic  control  method  is 
established  for  two  types  of  grasp  motion:  loose  grasp  and  firm  grasp.  In  order  for  the 
system  to  stay  in  the  stable  region,  low  gains  are  used  for  the  soft  grip  whereas  higher 
gains  are  required  for  the  firm  grip  to  provide  a  stronger  sensation  force  reflection.  From 
the  experimental  results,  the  base  value  of  0.35-0.5  is  to  be  used  for  the  soft  grasp,  and 
0.8-1.0  for  firm  grasp.  (The  base  value  was  defined  in  Chapter  5,  Section  5.2.) 

In  addition,  the  performance  of  PID  and  fuzzy  logic  controllers  on  the  1-DOF 
FRMC  is  compared.  The  results  show  that  each  has  its  benefits  and  drawbacks.  For  in¬ 
stance,  PID  produces  transient  oscillations  but  no  steady-state  error  while  the  fuzzy  logic 
controller  shows  slower  response  and  displays  some  steady-state  error,  but  no  oscilla¬ 
tions.  Note  that  these  errors  are  minimal  such  that  human  cannot  detect,  and  as  a  result, 
both  controllers  are  considered  to  be  acceptable  for  the  purpose  of  force-reflecting  man¬ 
ual  controller  application. 

In  chapter  6,  the  concept  of  the  telesensation  system  is  presented.  The  main  com¬ 
ponents  of  the  system,  which  includes  the  Virtual  Reality  unit,  Force-Reflecting  Manual 
Controller,  and  Graphical  User  Interface,  are  discussed.  Commercial  VR  units  are  pre¬ 
sented  in  order  to  identify  a  suitable  unit  for  the  ongoing  development  of  the  telesensation 
system.  After  a  thorough  study  on  these  units,  either  Kaiser  Electro-Optics’s  VIM 
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lOOOHRpv  or  Virtual  Research  Systems’s  VR4  can  be  implemented  in  the  system.  Both 
systems  provide  built-in  stereo  headphones  and  a  good  range  of  field  of  view  with  fine 
resolution.  Their  lightweight  and  reasonable  costs  make  them  more  attractive.  In  the  sec¬ 
tion  on  force-reflecting  manual  controllers,  the  results  of  a  survey  on  the  electric  motors 
currently  available  in  the  market  is  presented,  and  the  four  design  alternatives  are  pro¬ 
posed.  At  this  stage,  it  is  concluded  that  the  parallel  configuration  (design  alternative  3 
with  gimbal  configuration)  with  direct-drive  actuator  system  is  the  most  compact  and 
promising  design  because  it  provides  a  good  range  of  workspace  and  ease  of  assembly. 
Finally,  the  graphical  interface  software  is  developed  in  the  C++  environment.  Both 
Windows-based  and  DOS-based  versions  are  developed.  However,  the  final  decision  is 
made  to  fully  develop  the  software  on  a  DOS-based  platform  because  it  is  relatively 
faster  when  real-time  operation  is  one  of  the  measurements.  The  software  is  used  to  inter¬ 
face  with  various  components  such  as  CCD  camera,  encoder,  force/torque  sensor  and  VR 
unit  in  the  future. 

7.2  Recommendations 

Although  the  goal  of  this  work  has  been  achieved,  looking  back  at  the  work  con¬ 
ducted,  we  can  always  identify  areas  where  further  improvement  can  be  introduced.  In 
this  work,  a  better  controller  card  may  have  been  selected  for  the  1-DOF  testbed. 

The  compatibility  of  the  C  library  of  the  controller  card  is  limited  to  an  older  ver¬ 
sion  of  the  C++  compiler  (Borland  C++  version  4.0)  than  is  available  currently.  This  re¬ 
striction  made  it  impossible  to  develop  the  GUI  software  in  the  newer  version  of  the  C++ 
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compiler.  As  a  result,  the  GUI  software  was  taken  longer  time  to  develop  since  the  older 
version  of  the  C++  compiler  is  not  user-friendly  as  the  latest  version. 

7.3  Future  Work 

As  for  the  future  work,  the  concept  of  the  telesensation  system  will  be  fully  im¬ 
plemented.  This  includes  the  development  of  a  3 -DOF  FRMC,  the  addition  of  the  VR 
unit,  and  the  complete  version  of  the  GUI  software  package.  Each  of  these  components 
will  involve  the  work  described  below. 

(i)  The  development  of  a  3-DOF  FRMC 

A  3-DOF  FRMC  will  be  developed  based  on  the  design  alternatives  from  this 
work.  The  main  concern  in  developing  this  system  is  the  size  of  the  actuator.  This  is  the 
most  crucial  factor  because  the  size  of  the  system  will  be  determined  mainly  from  the 
size  of  the  actuator.  Therefore,  an  extensive  survey  of  actuators  must  be  conducted  in  or¬ 
der  to  identify  the  most  compact  system  available  in  the  market.  In  addition,  a  direct- 
drive  configuration  is  considered  to  be  the  most  promising  candidate  since  the  actuators 
today  are  small,  powerful,  and  they  are  capable  of  carrying  loads  without  the  need  of  the 
transmission  elements  such  as  gears.  This,  in  turn,  will  dramatically  reduce  backlash  and 
friction. 

(ii)  The  implementation  of  a  VR  unit 

A  VR  unit  will  be  implemented  as  an  additional  visual  feedback  beside  the  CCD 
camera  that  is  attached  on  the  remote  system.  This  unit  will  greatly  improve  the  visual 
perception  of  the  operator  since  it  is  generally  easier  to  identify  3-D  objects  than  two- 
dimensional  objects.  A  survey  of  the  commercial  units  has  been  conducted  in  this  work, 
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but  a  more  detailed  study  must  be  performed,  especially  on  the  software  package.  The 
software  program  must  provide  built-in  features  to  create  new  environments  with  ease. 
For  instance,  a  description  of  the  remote  environment  (such  as  the  nuclear  reactors)  must 
be  developed  with  relative  ease.  In  addition,  the  software  needs  to  be  compatible  with  the 
FRMC  and  GUI  software. 

(iii)  The  development  of  a  complete  GUI  software 

A  GUI  software  package  will  be  fully  developed  for  the  use  of  the  3 -DOF  FRMC. 
Various  components  such  as  VR  unit,  microphone,  speakers,  etc.  must  be  integrated  into 
this  software  with  relative  ease.  The  software  should  also  be  developed  to  the  point  where 
it  can  control  and  manipulate  a  6-DOF  or  even  redundant  (robots  with  more  than  6  de¬ 
grees  of  freedom)  remote  system.  This  may  be  possible  by  developing  a  toggle  button 
where  the  operator  can  control  a  group  of  joints  at  a  time  and  switch  the  control  mode 
between  translational  and  rotational  motions.  Alternatively,  two  3 -DOF  joysticks  may 
also  be  developed  for  this  purpose. 

After  the  development  of  above  components,  a  full-scale  prototype  can  be  built 
and  its  operation  improved  as  a  testing  program  is  carried  out  and  modifications  in  me¬ 
chanical  design,  controller  and  software  are  implemented.  Once  the  laboratory  evalua¬ 
tions  and  system  modifications  are  completed,  the  system  can  be  tested  in  the  field  in  a 
suitable  application. 
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APPENDIX 


CONCEPTUAL  DESIGN  OF  3-DEGREE-OF-FREEDOM 
FORCE-REFLECTING  MANUAL  CONTROLLER 

•  Proposed  Design  1 

•  Proposed  Design  2 

•  Proposed  Design  3 

•  Proposed  Design  4 
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